xref: /freebsd/sys/dev/sound/pci/hda/hdaa.c (revision 516a9c0212b003e1da0c6f4476dbe4f3f431606c)
1 /*-
2  * SPDX-License-Identifier: BSD-2-Clause
3  *
4  * Copyright (c) 2006 Stephane E. Potvin <sepotvin@videotron.ca>
5  * Copyright (c) 2006 Ariff Abdullah <ariff@FreeBSD.org>
6  * Copyright (c) 2008-2012 Alexander Motin <mav@FreeBSD.org>
7  * All rights reserved.
8  *
9  * Redistribution and use in source and binary forms, with or without
10  * modification, are permitted provided that the following conditions
11  * are met:
12  * 1. Redistributions of source code must retain the above copyright
13  *    notice, this list of conditions and the following disclaimer.
14  * 2. Redistributions in binary form must reproduce the above copyright
15  *    notice, this list of conditions and the following disclaimer in the
16  *    documentation and/or other materials provided with the distribution.
17  *
18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
19  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
22  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28  * SUCH DAMAGE.
29  */
30 
31 /*
32  * Intel High Definition Audio (Audio function) driver for FreeBSD.
33  */
34 
35 #ifdef HAVE_KERNEL_OPTION_HEADERS
36 #include "opt_snd.h"
37 #endif
38 
39 #include <dev/sound/pcm/sound.h>
40 
41 #include <sys/ctype.h>
42 #include <sys/taskqueue.h>
43 
44 #include <dev/sound/pci/hda/hdac.h>
45 #include <dev/sound/pci/hda/hdaa.h>
46 #include <dev/sound/pci/hda/hda_reg.h>
47 
48 #include "mixer_if.h"
49 
50 #define hdaa_lock(devinfo)	snd_mtxlock((devinfo)->lock)
51 #define hdaa_unlock(devinfo)	snd_mtxunlock((devinfo)->lock)
52 #define hdaa_lockassert(devinfo) snd_mtxassert((devinfo)->lock)
53 
54 static const struct {
55 	const char *key;
56 	uint32_t value;
57 } hdaa_quirks_tab[] = {
58 	{ "softpcmvol", HDAA_QUIRK_SOFTPCMVOL },
59 	{ "fixedrate", HDAA_QUIRK_FIXEDRATE },
60 	{ "forcestereo", HDAA_QUIRK_FORCESTEREO },
61 	{ "eapdinv", HDAA_QUIRK_EAPDINV },
62 	{ "senseinv", HDAA_QUIRK_SENSEINV },
63 	{ "ivref50", HDAA_QUIRK_IVREF50 },
64 	{ "ivref80", HDAA_QUIRK_IVREF80 },
65 	{ "ivref100", HDAA_QUIRK_IVREF100 },
66 	{ "ovref50", HDAA_QUIRK_OVREF50 },
67 	{ "ovref80", HDAA_QUIRK_OVREF80 },
68 	{ "ovref100", HDAA_QUIRK_OVREF100 },
69 	{ "ivref", HDAA_QUIRK_IVREF },
70 	{ "ovref", HDAA_QUIRK_OVREF },
71 	{ "vref", HDAA_QUIRK_VREF },
72 };
73 
74 #define HDA_PARSE_MAXDEPTH	10
75 
76 MALLOC_DEFINE(M_HDAA, "hdaa", "HDA Audio");
77 
78 static const char *HDA_COLORS[16] = {"Unknown", "Black", "Grey", "Blue",
79     "Green", "Red", "Orange", "Yellow", "Purple", "Pink", "Res.A", "Res.B",
80     "Res.C", "Res.D", "White", "Other"};
81 
82 static const char *HDA_DEVS[16] = {"Line-out", "Speaker", "Headphones", "CD",
83     "SPDIF-out", "Digital-out", "Modem-line", "Modem-handset", "Line-in",
84     "AUX", "Mic", "Telephony", "SPDIF-in", "Digital-in", "Res.E", "Other"};
85 
86 static const char *HDA_CONNS[4] = {"Jack", "None", "Fixed", "Both"};
87 
88 static const char *HDA_CONNECTORS[16] = {
89     "Unknown", "1/8", "1/4", "ATAPI", "RCA", "Optical", "Digital", "Analog",
90     "DIN", "XLR", "RJ-11", "Combo", "0xc", "0xd", "0xe", "Other" };
91 
92 static const char *HDA_LOCS[64] = {
93     "0x00", "Rear", "Front", "Left", "Right", "Top", "Bottom", "Rear-panel",
94 	"Drive-bay", "0x09", "0x0a", "0x0b", "0x0c", "0x0d", "0x0e", "0x0f",
95     "Internal", "0x11", "0x12", "0x13", "0x14", "0x15", "0x16", "Riser",
96 	"0x18", "Onboard", "0x1a", "0x1b", "0x1c", "0x1d", "0x1e", "0x1f",
97     "External", "Ext-Rear", "Ext-Front", "Ext-Left", "Ext-Right", "Ext-Top", "Ext-Bottom", "0x07",
98 	"0x28", "0x29", "0x2a", "0x2b", "0x2c", "0x2d", "0x2e", "0x2f",
99     "Other", "0x31", "0x32", "0x33", "0x34", "0x35", "Other-Bott", "Lid-In",
100 	"Lid-Out", "0x39", "0x3a", "0x3b", "0x3c", "0x3d", "0x3e", "0x3f" };
101 
102 static const char *HDA_GPIO_ACTIONS[8] = {
103     "keep", "set", "clear", "disable", "input", "0x05", "0x06", "0x07"};
104 
105 static const char *HDA_HDMI_CODING_TYPES[18] = {
106     "undefined", "LPCM", "AC-3", "MPEG1", "MP3", "MPEG2", "AAC-LC", "DTS",
107     "ATRAC", "DSD", "E-AC-3", "DTS-HD", "MLP", "DST", "WMAPro", "HE-AAC",
108     "HE-AACv2", "MPEG-Surround"
109 };
110 
111 /* Default */
112 static uint32_t hdaa_fmt[] = {
113 	SND_FORMAT(AFMT_S16_LE, 2, 0),
114 	0
115 };
116 
117 static struct pcmchan_caps hdaa_caps = {48000, 48000, hdaa_fmt, 0};
118 
119 static const struct {
120 	uint32_t	rate;
121 	int		valid;
122 	uint16_t	base;
123 	uint16_t	mul;
124 	uint16_t	div;
125 } hda_rate_tab[] = {
126 	{   8000, 1, 0x0000, 0x0000, 0x0500 },	/* (48000 * 1) / 6 */
127 	{   9600, 0, 0x0000, 0x0000, 0x0400 },	/* (48000 * 1) / 5 */
128 	{  12000, 0, 0x0000, 0x0000, 0x0300 },	/* (48000 * 1) / 4 */
129 	{  16000, 1, 0x0000, 0x0000, 0x0200 },	/* (48000 * 1) / 3 */
130 	{  18000, 0, 0x0000, 0x1000, 0x0700 },	/* (48000 * 3) / 8 */
131 	{  19200, 0, 0x0000, 0x0800, 0x0400 },	/* (48000 * 2) / 5 */
132 	{  24000, 0, 0x0000, 0x0000, 0x0100 },	/* (48000 * 1) / 2 */
133 	{  28800, 0, 0x0000, 0x1000, 0x0400 },	/* (48000 * 3) / 5 */
134 	{  32000, 1, 0x0000, 0x0800, 0x0200 },	/* (48000 * 2) / 3 */
135 	{  36000, 0, 0x0000, 0x1000, 0x0300 },	/* (48000 * 3) / 4 */
136 	{  38400, 0, 0x0000, 0x1800, 0x0400 },	/* (48000 * 4) / 5 */
137 	{  48000, 1, 0x0000, 0x0000, 0x0000 },	/* (48000 * 1) / 1 */
138 	{  64000, 0, 0x0000, 0x1800, 0x0200 },	/* (48000 * 4) / 3 */
139 	{  72000, 0, 0x0000, 0x1000, 0x0100 },	/* (48000 * 3) / 2 */
140 	{  96000, 1, 0x0000, 0x0800, 0x0000 },	/* (48000 * 2) / 1 */
141 	{ 144000, 0, 0x0000, 0x1000, 0x0000 },	/* (48000 * 3) / 1 */
142 	{ 192000, 1, 0x0000, 0x1800, 0x0000 },	/* (48000 * 4) / 1 */
143 	{   8820, 0, 0x4000, 0x0000, 0x0400 },	/* (44100 * 1) / 5 */
144 	{  11025, 1, 0x4000, 0x0000, 0x0300 },	/* (44100 * 1) / 4 */
145 	{  12600, 0, 0x4000, 0x0800, 0x0600 },	/* (44100 * 2) / 7 */
146 	{  14700, 0, 0x4000, 0x0000, 0x0200 },	/* (44100 * 1) / 3 */
147 	{  17640, 0, 0x4000, 0x0800, 0x0400 },	/* (44100 * 2) / 5 */
148 	{  18900, 0, 0x4000, 0x1000, 0x0600 },	/* (44100 * 3) / 7 */
149 	{  22050, 1, 0x4000, 0x0000, 0x0100 },	/* (44100 * 1) / 2 */
150 	{  25200, 0, 0x4000, 0x1800, 0x0600 },	/* (44100 * 4) / 7 */
151 	{  26460, 0, 0x4000, 0x1000, 0x0400 },	/* (44100 * 3) / 5 */
152 	{  29400, 0, 0x4000, 0x0800, 0x0200 },	/* (44100 * 2) / 3 */
153 	{  33075, 0, 0x4000, 0x1000, 0x0300 },	/* (44100 * 3) / 4 */
154 	{  35280, 0, 0x4000, 0x1800, 0x0400 },	/* (44100 * 4) / 5 */
155 	{  44100, 1, 0x4000, 0x0000, 0x0000 },	/* (44100 * 1) / 1 */
156 	{  58800, 0, 0x4000, 0x1800, 0x0200 },	/* (44100 * 4) / 3 */
157 	{  66150, 0, 0x4000, 0x1000, 0x0100 },	/* (44100 * 3) / 2 */
158 	{  88200, 1, 0x4000, 0x0800, 0x0000 },	/* (44100 * 2) / 1 */
159 	{ 132300, 0, 0x4000, 0x1000, 0x0000 },	/* (44100 * 3) / 1 */
160 	{ 176400, 1, 0x4000, 0x1800, 0x0000 },	/* (44100 * 4) / 1 */
161 };
162 #define HDA_RATE_TAB_LEN (sizeof(hda_rate_tab) / sizeof(hda_rate_tab[0]))
163 
164 const static char *ossnames[] = SOUND_DEVICE_NAMES;
165 
166 /****************************************************************************
167  * Function prototypes
168  ****************************************************************************/
169 static int	hdaa_pcmchannel_setup(struct hdaa_chan *);
170 
171 static void	hdaa_widget_connection_select(struct hdaa_widget *, uint8_t);
172 static void	hdaa_audio_ctl_amp_set(struct hdaa_audio_ctl *,
173 						uint32_t, int, int);
174 static struct	hdaa_audio_ctl *hdaa_audio_ctl_amp_get(struct hdaa_devinfo *,
175 							nid_t, int, int, int);
176 static void	hdaa_audio_ctl_amp_set_internal(struct hdaa_devinfo *,
177 				nid_t, int, int, int, int, int, int);
178 
179 static void	hdaa_dump_pin_config(struct hdaa_widget *w, uint32_t conf);
180 
181 static char *
hdaa_audio_ctl_ossmixer_mask2allname(uint32_t mask,char * buf,size_t len)182 hdaa_audio_ctl_ossmixer_mask2allname(uint32_t mask, char *buf, size_t len)
183 {
184 	int i, first = 1;
185 
186 	bzero(buf, len);
187 	for (i = 0; i < SOUND_MIXER_NRDEVICES; i++) {
188 		if (mask & (1 << i)) {
189 			if (first == 0)
190 				strlcat(buf, ", ", len);
191 			strlcat(buf, ossnames[i], len);
192 			first = 0;
193 		}
194 	}
195 	return (buf);
196 }
197 
198 static struct hdaa_audio_ctl *
hdaa_audio_ctl_each(struct hdaa_devinfo * devinfo,int * index)199 hdaa_audio_ctl_each(struct hdaa_devinfo *devinfo, int *index)
200 {
201 	if (devinfo == NULL ||
202 	    index == NULL || devinfo->ctl == NULL ||
203 	    devinfo->ctlcnt < 1 ||
204 	    *index < 0 || *index >= devinfo->ctlcnt)
205 		return (NULL);
206 	return (&devinfo->ctl[(*index)++]);
207 }
208 
209 static struct hdaa_audio_ctl *
hdaa_audio_ctl_amp_get(struct hdaa_devinfo * devinfo,nid_t nid,int dir,int index,int cnt)210 hdaa_audio_ctl_amp_get(struct hdaa_devinfo *devinfo, nid_t nid, int dir,
211 						int index, int cnt)
212 {
213 	struct hdaa_audio_ctl *ctl;
214 	int i, found = 0;
215 
216 	if (devinfo == NULL || devinfo->ctl == NULL)
217 		return (NULL);
218 
219 	i = 0;
220 	while ((ctl = hdaa_audio_ctl_each(devinfo, &i)) != NULL) {
221 		if (ctl->enable == 0)
222 			continue;
223 		if (ctl->widget->nid != nid)
224 			continue;
225 		if (dir && ctl->ndir != dir)
226 			continue;
227 		if (index >= 0 && ctl->ndir == HDAA_CTL_IN &&
228 		    ctl->dir == ctl->ndir && ctl->index != index)
229 			continue;
230 		found++;
231 		if (found == cnt || cnt <= 0)
232 			return (ctl);
233 	}
234 
235 	return (NULL);
236 }
237 
238 static const struct matrix {
239 	struct pcmchan_matrix	m;
240 	int			analog;
241 } matrixes[]  = {
242     { SND_CHN_MATRIX_MAP_1_0,	1 },
243     { SND_CHN_MATRIX_MAP_2_0,	1 },
244     { SND_CHN_MATRIX_MAP_2_1,	0 },
245     { SND_CHN_MATRIX_MAP_3_0,	0 },
246     { SND_CHN_MATRIX_MAP_3_1,	0 },
247     { SND_CHN_MATRIX_MAP_4_0,	1 },
248     { SND_CHN_MATRIX_MAP_4_1,	0 },
249     { SND_CHN_MATRIX_MAP_5_0,	0 },
250     { SND_CHN_MATRIX_MAP_5_1,	1 },
251     { SND_CHN_MATRIX_MAP_6_0,	0 },
252     { SND_CHN_MATRIX_MAP_6_1,	0 },
253     { SND_CHN_MATRIX_MAP_7_0,	0 },
254     { SND_CHN_MATRIX_MAP_7_1,	1 },
255 };
256 
257 static const char *channel_names[] = SND_CHN_T_NAMES;
258 
259 /*
260  * Connected channels change handler.
261  */
262 static void
hdaa_channels_handler(struct hdaa_audio_as * as)263 hdaa_channels_handler(struct hdaa_audio_as *as)
264 {
265 	struct hdaa_pcm_devinfo *pdevinfo = as->pdevinfo;
266 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
267 	struct hdaa_chan *ch = &devinfo->chans[as->chans[0]];
268 	struct hdaa_widget *w;
269 	uint8_t *eld;
270 	int total, sub, assume, channels;
271 	size_t i;
272 	uint16_t cpins, upins, tpins;
273 
274 	cpins = upins = 0;
275 	eld = NULL;
276 	for (i = 0; i < 16; i++) {
277 		if (as->pins[i] <= 0)
278 			continue;
279 		w = hdaa_widget_get(devinfo, as->pins[i]);
280 		if (w == NULL)
281 			continue;
282 		if (w->wclass.pin.connected == 1)
283 			cpins |= (1 << i);
284 		else if (w->wclass.pin.connected != 0)
285 			upins |= (1 << i);
286 		if (w->eld != NULL && w->eld_len >= 8)
287 			eld = w->eld;
288 	}
289 	tpins = cpins | upins;
290 	if (as->hpredir >= 0)
291 		tpins &= 0x7fff;
292 	if (tpins == 0)
293 		tpins = as->pinset;
294 
295 	total = sub = assume = channels = 0;
296 	if (eld) {
297 		/* Map CEA speakers to sound(4) channels. */
298 		if (eld[7] & 0x01) /* Front Left/Right */
299 			channels |= SND_CHN_T_MASK_FL | SND_CHN_T_MASK_FR;
300 		if (eld[7] & 0x02) /* Low Frequency Effect */
301 			channels |= SND_CHN_T_MASK_LF;
302 		if (eld[7] & 0x04) /* Front Center */
303 			channels |= SND_CHN_T_MASK_FC;
304 		if (eld[7] & 0x08) { /* Rear Left/Right */
305 			/* If we have both RLR and RLRC, report RLR as side. */
306 			if (eld[7] & 0x40) /* Rear Left/Right Center */
307 			    channels |= SND_CHN_T_MASK_SL | SND_CHN_T_MASK_SR;
308 			else
309 			    channels |= SND_CHN_T_MASK_BL | SND_CHN_T_MASK_BR;
310 		}
311 		if (eld[7] & 0x10) /* Rear center */
312 			channels |= SND_CHN_T_MASK_BC;
313 		if (eld[7] & 0x20) /* Front Left/Right Center */
314 			channels |= SND_CHN_T_MASK_FLC | SND_CHN_T_MASK_FRC;
315 		if (eld[7] & 0x40) /* Rear Left/Right Center */
316 			channels |= SND_CHN_T_MASK_BL | SND_CHN_T_MASK_BR;
317 	} else if (as->pinset != 0 && (tpins & 0xffe0) == 0) {
318 		/* Map UAA speakers to sound(4) channels. */
319 		if (tpins & 0x0001)
320 			channels |= SND_CHN_T_MASK_FL | SND_CHN_T_MASK_FR;
321 		if (tpins & 0x0002)
322 			channels |= SND_CHN_T_MASK_FC | SND_CHN_T_MASK_LF;
323 		if (tpins & 0x0004)
324 			channels |= SND_CHN_T_MASK_BL | SND_CHN_T_MASK_BR;
325 		if (tpins & 0x0008)
326 			channels |= SND_CHN_T_MASK_FLC | SND_CHN_T_MASK_FRC;
327 		if (tpins & 0x0010) {
328 			/* If there is no back pin, report side as back. */
329 			if ((as->pinset & 0x0004) == 0)
330 			    channels |= SND_CHN_T_MASK_BL | SND_CHN_T_MASK_BR;
331 			else
332 			    channels |= SND_CHN_T_MASK_SL | SND_CHN_T_MASK_SR;
333 		}
334 	} else if (as->mixed) {
335 		/* Mixed assoc can be only stereo or theoretically mono. */
336 		if (ch->channels == 1)
337 			channels |= SND_CHN_T_MASK_FC;
338 		else
339 			channels |= SND_CHN_T_MASK_FL | SND_CHN_T_MASK_FR;
340 	}
341 	if (channels) {	/* We have some usable channels info. */
342 		HDA_BOOTVERBOSE(
343 			device_printf(pdevinfo->dev, "%s channel set is: ",
344 			    as->dir == HDAA_CTL_OUT ? "Playback" : "Recording");
345 			for (i = 0; i < SND_CHN_T_MAX; i++)
346 				if (channels & (1 << i))
347 					printf("%s, ", channel_names[i]);
348 			printf("\n");
349 		);
350 		/* Look for maximal fitting matrix. */
351 		for (i = 0; i < nitems(matrixes); i++) {
352 			if (as->pinset != 0 && matrixes[i].analog == 0)
353 				continue;
354 			if ((matrixes[i].m.mask & ~channels) == 0) {
355 				total = matrixes[i].m.channels;
356 				sub = matrixes[i].m.ext;
357 			}
358 		}
359 	}
360 	if (total == 0) {
361 		assume = 1;
362 		total = ch->channels;
363 		sub = (total == 6 || total == 8) ? 1 : 0;
364 	}
365 	HDA_BOOTVERBOSE(
366 		device_printf(pdevinfo->dev,
367 		    "%s channel matrix is: %s%d.%d (%s)\n",
368 		    as->dir == HDAA_CTL_OUT ? "Playback" : "Recording",
369 		    assume ? "unknown, assuming " : "", total - sub, sub,
370 		    cpins != 0 ? "connected" :
371 		    (upins != 0 ? "unknown" : "disconnected"));
372 	);
373 }
374 
375 /*
376  * Headphones redirection change handler.
377  */
378 static void
hdaa_hpredir_handler(struct hdaa_widget * w)379 hdaa_hpredir_handler(struct hdaa_widget *w)
380 {
381 	struct hdaa_devinfo *devinfo = w->devinfo;
382 	struct hdaa_audio_as *as = &devinfo->as[w->bindas];
383 	struct hdaa_widget *w1;
384 	struct hdaa_audio_ctl *ctl;
385 	uint32_t val;
386 	int j, connected = w->wclass.pin.connected;
387 
388 	HDA_BOOTVERBOSE(
389 		device_printf((as->pdevinfo && as->pdevinfo->dev) ?
390 		    as->pdevinfo->dev : devinfo->dev,
391 		    "Redirect output to: %s\n",
392 		    connected ? "headphones": "main");
393 	);
394 	/* (Un)Mute headphone pin. */
395 	ctl = hdaa_audio_ctl_amp_get(devinfo,
396 	    w->nid, HDAA_CTL_IN, -1, 1);
397 	if (ctl != NULL && ctl->mute) {
398 		/* If pin has muter - use it. */
399 		val = connected ? 0 : 1;
400 		if (val != ctl->forcemute) {
401 			ctl->forcemute = val;
402 			hdaa_audio_ctl_amp_set(ctl,
403 			    HDAA_AMP_MUTE_DEFAULT,
404 			    HDAA_AMP_VOL_DEFAULT, HDAA_AMP_VOL_DEFAULT);
405 		}
406 	} else {
407 		/* If there is no muter - disable pin output. */
408 		if (connected)
409 			val = w->wclass.pin.ctrl |
410 			    HDA_CMD_SET_PIN_WIDGET_CTRL_OUT_ENABLE;
411 		else
412 			val = w->wclass.pin.ctrl &
413 			    ~HDA_CMD_SET_PIN_WIDGET_CTRL_OUT_ENABLE;
414 		if (val != w->wclass.pin.ctrl) {
415 			w->wclass.pin.ctrl = val;
416 			hda_command(devinfo->dev,
417 			    HDA_CMD_SET_PIN_WIDGET_CTRL(0,
418 			    w->nid, w->wclass.pin.ctrl));
419 		}
420 	}
421 	/* (Un)Mute other pins. */
422 	for (j = 0; j < 15; j++) {
423 		if (as->pins[j] <= 0)
424 			continue;
425 		ctl = hdaa_audio_ctl_amp_get(devinfo,
426 		    as->pins[j], HDAA_CTL_IN, -1, 1);
427 		if (ctl != NULL && ctl->mute) {
428 			/* If pin has muter - use it. */
429 			val = connected ? 1 : 0;
430 			if (val == ctl->forcemute)
431 				continue;
432 			ctl->forcemute = val;
433 			hdaa_audio_ctl_amp_set(ctl,
434 			    HDAA_AMP_MUTE_DEFAULT,
435 			    HDAA_AMP_VOL_DEFAULT, HDAA_AMP_VOL_DEFAULT);
436 			continue;
437 		}
438 		/* If there is no muter - disable pin output. */
439 		w1 = hdaa_widget_get(devinfo, as->pins[j]);
440 		if (w1 != NULL) {
441 			if (connected)
442 				val = w1->wclass.pin.ctrl &
443 				    ~HDA_CMD_SET_PIN_WIDGET_CTRL_OUT_ENABLE;
444 			else
445 				val = w1->wclass.pin.ctrl |
446 				    HDA_CMD_SET_PIN_WIDGET_CTRL_OUT_ENABLE;
447 			if (val != w1->wclass.pin.ctrl) {
448 				w1->wclass.pin.ctrl = val;
449 				hda_command(devinfo->dev,
450 				    HDA_CMD_SET_PIN_WIDGET_CTRL(0,
451 				    w1->nid, w1->wclass.pin.ctrl));
452 			}
453 		}
454 	}
455 }
456 
457 /*
458  * Recording source change handler.
459  */
460 static void
hdaa_autorecsrc_handler(struct hdaa_audio_as * as,struct hdaa_widget * w)461 hdaa_autorecsrc_handler(struct hdaa_audio_as *as, struct hdaa_widget *w)
462 {
463 	struct hdaa_pcm_devinfo *pdevinfo = as->pdevinfo;
464 	struct hdaa_devinfo *devinfo;
465 	struct hdaa_widget *w1;
466 	int i, mask, fullmask, prio, bestprio;
467 	char buf[128];
468 
469 	if (!as->mixed || pdevinfo == NULL || pdevinfo->mixer == NULL)
470 		return;
471 	/* Don't touch anything if we asked not to. */
472 	if (pdevinfo->autorecsrc == 0 ||
473 	    (pdevinfo->autorecsrc == 1 && w != NULL))
474 		return;
475 	/* Don't touch anything if "mix" or "speaker" selected. */
476 	if (pdevinfo->recsrc & (SOUND_MASK_IMIX | SOUND_MASK_SPEAKER))
477 		return;
478 	/* Don't touch anything if several selected. */
479 	if (ffs(pdevinfo->recsrc) != fls(pdevinfo->recsrc))
480 		return;
481 	devinfo = pdevinfo->devinfo;
482 	mask = fullmask = 0;
483 	bestprio = 0;
484 	for (i = 0; i < 16; i++) {
485 		if (as->pins[i] <= 0)
486 			continue;
487 		w1 = hdaa_widget_get(devinfo, as->pins[i]);
488 		if (w1 == NULL || w1->enable == 0)
489 			continue;
490 		if (w1->wclass.pin.connected == 0)
491 			continue;
492 		prio = (w1->wclass.pin.connected == 1) ? 2 : 1;
493 		if (prio < bestprio)
494 			continue;
495 		if (prio > bestprio) {
496 			mask = 0;
497 			bestprio = prio;
498 		}
499 		mask |= (1 << w1->ossdev);
500 		fullmask |= (1 << w1->ossdev);
501 	}
502 	if (mask == 0)
503 		return;
504 	/* Prefer newly connected input. */
505 	if (w != NULL && (mask & (1 << w->ossdev)))
506 		mask = (1 << w->ossdev);
507 	/* Prefer previously selected input */
508 	if (mask & pdevinfo->recsrc)
509 		mask &= pdevinfo->recsrc;
510 	/* Prefer mic. */
511 	if (mask & SOUND_MASK_MIC)
512 		mask = SOUND_MASK_MIC;
513 	/* Prefer monitor (2nd mic). */
514 	if (mask & SOUND_MASK_MONITOR)
515 		mask = SOUND_MASK_MONITOR;
516 	/* Just take first one. */
517 	mask = (1 << (ffs(mask) - 1));
518 	HDA_BOOTVERBOSE(
519 		hdaa_audio_ctl_ossmixer_mask2allname(mask, buf, sizeof(buf));
520 		device_printf(pdevinfo->dev,
521 		    "Automatically set rec source to: %s\n", buf);
522 	);
523 	hdaa_unlock(devinfo);
524 	mix_setrecsrc(pdevinfo->mixer, mask);
525 	hdaa_lock(devinfo);
526 }
527 
528 /*
529  * Jack presence detection event handler.
530  */
531 static void
hdaa_presence_handler(struct hdaa_widget * w)532 hdaa_presence_handler(struct hdaa_widget *w)
533 {
534 	struct hdaa_devinfo *devinfo = w->devinfo;
535 	struct hdaa_audio_as *as;
536 	uint32_t res;
537 	int connected, old;
538 
539 	if (w->enable == 0 || w->type !=
540 	    HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
541 		return;
542 
543 	if (HDA_PARAM_PIN_CAP_PRESENCE_DETECT_CAP(w->wclass.pin.cap) == 0 ||
544 	    (HDA_CONFIG_DEFAULTCONF_MISC(w->wclass.pin.config) & 1) != 0)
545 		return;
546 
547 	res = hda_command(devinfo->dev, HDA_CMD_GET_PIN_SENSE(0, w->nid));
548 	connected = (res & HDA_CMD_GET_PIN_SENSE_PRESENCE_DETECT) != 0;
549 	if (devinfo->quirks & HDAA_QUIRK_SENSEINV)
550 		connected = !connected;
551 	old = w->wclass.pin.connected;
552 	if (connected == old)
553 		return;
554 	w->wclass.pin.connected = connected;
555 	HDA_BOOTVERBOSE(
556 		if (connected || old != 2) {
557 			device_printf(devinfo->dev,
558 			    "Pin sense: nid=%d sense=0x%08x (%sconnected)\n",
559 			    w->nid, res, !connected ? "dis" : "");
560 		}
561 	);
562 
563 	as = &devinfo->as[w->bindas];
564 	if (as->hpredir >= 0 && as->pins[15] == w->nid)
565 		hdaa_hpredir_handler(w);
566 	if (as->dir == HDAA_CTL_IN && old != 2)
567 		hdaa_autorecsrc_handler(as, w);
568 	if (old != 2)
569 		hdaa_channels_handler(as);
570 }
571 
572 /*
573  * Callback for poll based presence detection.
574  */
575 static void
hdaa_jack_poll_callback(void * arg)576 hdaa_jack_poll_callback(void *arg)
577 {
578 	struct hdaa_devinfo *devinfo = arg;
579 	struct hdaa_widget *w;
580 	int i;
581 
582 	hdaa_lock(devinfo);
583 	if (devinfo->poll_ival == 0) {
584 		hdaa_unlock(devinfo);
585 		return;
586 	}
587 	for (i = 0; i < devinfo->ascnt; i++) {
588 		if (devinfo->as[i].hpredir < 0)
589 			continue;
590 		w = hdaa_widget_get(devinfo, devinfo->as[i].pins[15]);
591 		if (w == NULL || w->enable == 0 || w->type !=
592 		    HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
593 			continue;
594 		hdaa_presence_handler(w);
595 	}
596 	callout_reset(&devinfo->poll_jack, devinfo->poll_ival,
597 	    hdaa_jack_poll_callback, devinfo);
598 	hdaa_unlock(devinfo);
599 }
600 
601 static void
hdaa_eld_dump(struct hdaa_widget * w)602 hdaa_eld_dump(struct hdaa_widget *w)
603 {
604 	struct hdaa_devinfo *devinfo = w->devinfo;
605 	device_t dev = devinfo->dev;
606 	uint8_t *sad;
607 	int mnl, i, sadc, fmt;
608 
609 	if (w->eld == NULL || w->eld_len < 4)
610 		return;
611 	device_printf(dev,
612 	    "ELD nid=%d: ELD_Ver=%u Baseline_ELD_Len=%u\n",
613 	    w->nid, w->eld[0] >> 3, w->eld[2]);
614 	if ((w->eld[0] >> 3) != 0x02)
615 		return;
616 	mnl = w->eld[4] & 0x1f;
617 	device_printf(dev,
618 	    "ELD nid=%d: CEA_EDID_Ver=%u MNL=%u\n",
619 	    w->nid, w->eld[4] >> 5, mnl);
620 	sadc = w->eld[5] >> 4;
621 	device_printf(dev,
622 	    "ELD nid=%d: SAD_Count=%u Conn_Type=%u S_AI=%u HDCP=%u\n",
623 	    w->nid, sadc, (w->eld[5] >> 2) & 0x3,
624 	    (w->eld[5] >> 1) & 0x1, w->eld[5] & 0x1);
625 	device_printf(dev,
626 	    "ELD nid=%d: Aud_Synch_Delay=%ums\n",
627 	    w->nid, w->eld[6] * 2);
628 	device_printf(dev,
629 	    "ELD nid=%d: Channels=0x%b\n",
630 	    w->nid, w->eld[7],
631 	    "\020\07RLRC\06FLRC\05RC\04RLR\03FC\02LFE\01FLR");
632 	device_printf(dev,
633 	    "ELD nid=%d: Port_ID=0x%02x%02x%02x%02x%02x%02x%02x%02x\n",
634 	    w->nid, w->eld[8], w->eld[9], w->eld[10], w->eld[11],
635 	    w->eld[12], w->eld[13], w->eld[14], w->eld[15]);
636 	device_printf(dev,
637 	    "ELD nid=%d: Manufacturer_Name=0x%02x%02x\n",
638 	    w->nid, w->eld[16], w->eld[17]);
639 	device_printf(dev,
640 	    "ELD nid=%d: Product_Code=0x%02x%02x\n",
641 	    w->nid, w->eld[18], w->eld[19]);
642 	device_printf(dev,
643 	    "ELD nid=%d: Monitor_Name_String='%.*s'\n",
644 	    w->nid, mnl, &w->eld[20]);
645 	for (i = 0; i < sadc; i++) {
646 		sad = &w->eld[20 + mnl + i * 3];
647 		fmt = (sad[0] >> 3) & 0x0f;
648 		if (fmt == HDA_HDMI_CODING_TYPE_REF_CTX) {
649 			fmt = (sad[2] >> 3) & 0x1f;
650 			if (fmt < 1 || fmt > 3)
651 				fmt = 0;
652 			else
653 				fmt += 14;
654 		}
655 		device_printf(dev,
656 		    "ELD nid=%d: %s %dch freqs=0x%b",
657 		    w->nid, HDA_HDMI_CODING_TYPES[fmt], (sad[0] & 0x07) + 1,
658 		    sad[1], "\020\007192\006176\00596\00488\00348\00244\00132");
659 		switch (fmt) {
660 		case HDA_HDMI_CODING_TYPE_LPCM:
661 			printf(" sizes=0x%b",
662 			    sad[2] & 0x07, "\020\00324\00220\00116");
663 			break;
664 		case HDA_HDMI_CODING_TYPE_AC3:
665 		case HDA_HDMI_CODING_TYPE_MPEG1:
666 		case HDA_HDMI_CODING_TYPE_MP3:
667 		case HDA_HDMI_CODING_TYPE_MPEG2:
668 		case HDA_HDMI_CODING_TYPE_AACLC:
669 		case HDA_HDMI_CODING_TYPE_DTS:
670 		case HDA_HDMI_CODING_TYPE_ATRAC:
671 			printf(" max_bitrate=%d", sad[2] * 8000);
672 			break;
673 		case HDA_HDMI_CODING_TYPE_WMAPRO:
674 			printf(" profile=%d", sad[2] & 0x07);
675 			break;
676 		}
677 		printf("\n");
678 	}
679 }
680 
681 static void
hdaa_eld_handler(struct hdaa_widget * w)682 hdaa_eld_handler(struct hdaa_widget *w)
683 {
684 	struct hdaa_devinfo *devinfo = w->devinfo;
685 	uint32_t res;
686 	int i;
687 
688 	if (w->enable == 0 || w->type !=
689 	    HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
690 		return;
691 
692 	if (HDA_PARAM_PIN_CAP_PRESENCE_DETECT_CAP(w->wclass.pin.cap) == 0 ||
693 	    (HDA_CONFIG_DEFAULTCONF_MISC(w->wclass.pin.config) & 1) != 0)
694 		return;
695 
696 	res = hda_command(devinfo->dev, HDA_CMD_GET_PIN_SENSE(0, w->nid));
697 	if ((w->eld != 0) == ((res & HDA_CMD_GET_PIN_SENSE_ELD_VALID) != 0))
698 		return;
699 	if (w->eld != NULL) {
700 		w->eld_len = 0;
701 		free(w->eld, M_HDAA);
702 		w->eld = NULL;
703 	}
704 	HDA_BOOTVERBOSE(
705 		device_printf(devinfo->dev,
706 		    "Pin sense: nid=%d sense=0x%08x "
707 		    "(%sconnected, ELD %svalid)\n",
708 		    w->nid, res,
709 		    (res & HDA_CMD_GET_PIN_SENSE_PRESENCE_DETECT) ? "" : "dis",
710 		    (res & HDA_CMD_GET_PIN_SENSE_ELD_VALID) ? "" : "in");
711 	);
712 	if ((res & HDA_CMD_GET_PIN_SENSE_ELD_VALID) == 0)
713 		return;
714 
715 	res = hda_command(devinfo->dev,
716 	    HDA_CMD_GET_HDMI_DIP_SIZE(0, w->nid, 0x08));
717 	if (res == HDA_INVALID)
718 		return;
719 	w->eld_len = res & 0xff;
720 	if (w->eld_len != 0)
721 		w->eld = malloc(w->eld_len, M_HDAA, M_ZERO | M_NOWAIT);
722 	if (w->eld == NULL) {
723 		w->eld_len = 0;
724 		return;
725 	}
726 
727 	for (i = 0; i < w->eld_len; i++) {
728 		res = hda_command(devinfo->dev,
729 		    HDA_CMD_GET_HDMI_ELDD(0, w->nid, i));
730 		if (res & 0x80000000)
731 			w->eld[i] = res & 0xff;
732 	}
733 	HDA_BOOTVERBOSE(
734 		hdaa_eld_dump(w);
735 	);
736 	hdaa_channels_handler(&devinfo->as[w->bindas]);
737 }
738 
739 /*
740  * Pin sense initializer.
741  */
742 static void
hdaa_sense_init(struct hdaa_devinfo * devinfo)743 hdaa_sense_init(struct hdaa_devinfo *devinfo)
744 {
745 	struct hdaa_audio_as *as;
746 	struct hdaa_widget *w;
747 	int i, poll = 0;
748 
749 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
750 		w = hdaa_widget_get(devinfo, i);
751 		if (w == NULL || w->enable == 0 || w->type !=
752 		    HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
753 			continue;
754 		if (HDA_PARAM_AUDIO_WIDGET_CAP_UNSOL_CAP(w->param.widget_cap)) {
755 			if (w->unsol < 0)
756 				w->unsol = HDAC_UNSOL_ALLOC(
757 				    device_get_parent(devinfo->dev),
758 				    devinfo->dev, w->nid);
759 			hda_command(devinfo->dev,
760 			    HDA_CMD_SET_UNSOLICITED_RESPONSE(0, w->nid,
761 			    HDA_CMD_SET_UNSOLICITED_RESPONSE_ENABLE | w->unsol));
762 		}
763 		as = &devinfo->as[w->bindas];
764 		if (as->hpredir >= 0 && as->pins[15] == w->nid) {
765 			if (HDA_PARAM_PIN_CAP_PRESENCE_DETECT_CAP(w->wclass.pin.cap) == 0 ||
766 			    (HDA_CONFIG_DEFAULTCONF_MISC(w->wclass.pin.config) & 1) != 0) {
767 				device_printf(devinfo->dev,
768 				    "No presence detection support at nid %d\n",
769 				    w->nid);
770 			} else {
771 				if (w->unsol < 0)
772 					poll = 1;
773 				HDA_BOOTVERBOSE(
774 					device_printf(devinfo->dev,
775 					    "Headphones redirection for "
776 					    "association %d nid=%d using %s.\n",
777 					    w->bindas, w->nid,
778 					    (w->unsol < 0) ? "polling" :
779 					    "unsolicited responses");
780 				);
781 			}
782 		}
783 		hdaa_presence_handler(w);
784 		if (!HDA_PARAM_PIN_CAP_DP(w->wclass.pin.cap) &&
785 		    !HDA_PARAM_PIN_CAP_HDMI(w->wclass.pin.cap))
786 			continue;
787 		hdaa_eld_handler(w);
788 	}
789 	if (poll) {
790 		callout_reset(&devinfo->poll_jack, 1,
791 		    hdaa_jack_poll_callback, devinfo);
792 	}
793 }
794 
795 static void
hdaa_sense_deinit(struct hdaa_devinfo * devinfo)796 hdaa_sense_deinit(struct hdaa_devinfo *devinfo)
797 {
798 	struct hdaa_widget *w;
799 	int i;
800 
801 	callout_stop(&devinfo->poll_jack);
802 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
803 		w = hdaa_widget_get(devinfo, i);
804 		if (w == NULL || w->enable == 0 || w->type !=
805 		    HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
806 			continue;
807 		if (w->unsol < 0)
808 			continue;
809 		hda_command(devinfo->dev,
810 		    HDA_CMD_SET_UNSOLICITED_RESPONSE(0, w->nid, 0));
811 		HDAC_UNSOL_FREE(
812 		    device_get_parent(devinfo->dev), devinfo->dev,
813 		    w->unsol);
814 		w->unsol = -1;
815 	}
816 }
817 
818 uint32_t
hdaa_widget_pin_patch(uint32_t config,const char * str)819 hdaa_widget_pin_patch(uint32_t config, const char *str)
820 {
821 	char buf[256];
822 	char *key, *value, *rest, *bad;
823 	int ival, i;
824 
825 	strlcpy(buf, str, sizeof(buf));
826 	rest = buf;
827 	while ((key = strsep(&rest, "=")) != NULL) {
828 		value = strsep(&rest, " \t");
829 		if (value == NULL)
830 			break;
831 		ival = strtol(value, &bad, 10);
832 		if (strcmp(key, "seq") == 0) {
833 			config &= ~HDA_CONFIG_DEFAULTCONF_SEQUENCE_MASK;
834 			config |= ((ival << HDA_CONFIG_DEFAULTCONF_SEQUENCE_SHIFT) &
835 			    HDA_CONFIG_DEFAULTCONF_SEQUENCE_MASK);
836 		} else if (strcmp(key, "as") == 0) {
837 			config &= ~HDA_CONFIG_DEFAULTCONF_ASSOCIATION_MASK;
838 			config |= ((ival << HDA_CONFIG_DEFAULTCONF_ASSOCIATION_SHIFT) &
839 			    HDA_CONFIG_DEFAULTCONF_ASSOCIATION_MASK);
840 		} else if (strcmp(key, "misc") == 0) {
841 			config &= ~HDA_CONFIG_DEFAULTCONF_MISC_MASK;
842 			config |= ((ival << HDA_CONFIG_DEFAULTCONF_MISC_SHIFT) &
843 			    HDA_CONFIG_DEFAULTCONF_MISC_MASK);
844 		} else if (strcmp(key, "color") == 0) {
845 			config &= ~HDA_CONFIG_DEFAULTCONF_COLOR_MASK;
846 			if (bad[0] == 0) {
847 				config |= ((ival << HDA_CONFIG_DEFAULTCONF_COLOR_SHIFT) &
848 				    HDA_CONFIG_DEFAULTCONF_COLOR_MASK);
849 			}
850 			for (i = 0; i < 16; i++) {
851 				if (strcasecmp(HDA_COLORS[i], value) == 0) {
852 					config |= (i << HDA_CONFIG_DEFAULTCONF_COLOR_SHIFT);
853 					break;
854 				}
855 			}
856 		} else if (strcmp(key, "ctype") == 0) {
857 			config &= ~HDA_CONFIG_DEFAULTCONF_CONNECTION_TYPE_MASK;
858 			if (bad[0] == 0) {
859 			config |= ((ival << HDA_CONFIG_DEFAULTCONF_CONNECTION_TYPE_SHIFT) &
860 			    HDA_CONFIG_DEFAULTCONF_CONNECTION_TYPE_MASK);
861 			}
862 			for (i = 0; i < 16; i++) {
863 				if (strcasecmp(HDA_CONNECTORS[i], value) == 0) {
864 					config |= (i << HDA_CONFIG_DEFAULTCONF_CONNECTION_TYPE_SHIFT);
865 					break;
866 				}
867 			}
868 		} else if (strcmp(key, "device") == 0) {
869 			config &= ~HDA_CONFIG_DEFAULTCONF_DEVICE_MASK;
870 			if (bad[0] == 0) {
871 				config |= ((ival << HDA_CONFIG_DEFAULTCONF_DEVICE_SHIFT) &
872 				    HDA_CONFIG_DEFAULTCONF_DEVICE_MASK);
873 				continue;
874 			}
875 			for (i = 0; i < 16; i++) {
876 				if (strcasecmp(HDA_DEVS[i], value) == 0) {
877 					config |= (i << HDA_CONFIG_DEFAULTCONF_DEVICE_SHIFT);
878 					break;
879 				}
880 			}
881 		} else if (strcmp(key, "loc") == 0) {
882 			config &= ~HDA_CONFIG_DEFAULTCONF_LOCATION_MASK;
883 			if (bad[0] == 0) {
884 				config |= ((ival << HDA_CONFIG_DEFAULTCONF_LOCATION_SHIFT) &
885 				    HDA_CONFIG_DEFAULTCONF_LOCATION_MASK);
886 				continue;
887 			}
888 			for (i = 0; i < 64; i++) {
889 				if (strcasecmp(HDA_LOCS[i], value) == 0) {
890 					config |= (i << HDA_CONFIG_DEFAULTCONF_LOCATION_SHIFT);
891 					break;
892 				}
893 			}
894 		} else if (strcmp(key, "conn") == 0) {
895 			config &= ~HDA_CONFIG_DEFAULTCONF_CONNECTIVITY_MASK;
896 			if (bad[0] == 0) {
897 				config |= ((ival << HDA_CONFIG_DEFAULTCONF_CONNECTIVITY_SHIFT) &
898 				    HDA_CONFIG_DEFAULTCONF_CONNECTIVITY_MASK);
899 				continue;
900 			}
901 			for (i = 0; i < 4; i++) {
902 				if (strcasecmp(HDA_CONNS[i], value) == 0) {
903 					config |= (i << HDA_CONFIG_DEFAULTCONF_CONNECTIVITY_SHIFT);
904 					break;
905 				}
906 			}
907 		}
908 	}
909 	return (config);
910 }
911 
912 uint32_t
hdaa_gpio_patch(uint32_t gpio,const char * str)913 hdaa_gpio_patch(uint32_t gpio, const char *str)
914 {
915 	char buf[256];
916 	char *key, *value, *rest;
917 	int ikey, i;
918 
919 	strlcpy(buf, str, sizeof(buf));
920 	rest = buf;
921 	while ((key = strsep(&rest, "=")) != NULL) {
922 		value = strsep(&rest, " \t");
923 		if (value == NULL)
924 			break;
925 		ikey = strtol(key, NULL, 10);
926 		if (ikey < 0 || ikey > 7)
927 			continue;
928 		for (i = 0; i < 7; i++) {
929 			if (strcasecmp(HDA_GPIO_ACTIONS[i], value) == 0) {
930 				gpio &= ~HDAA_GPIO_MASK(ikey);
931 				gpio |= i << HDAA_GPIO_SHIFT(ikey);
932 				break;
933 			}
934 		}
935 	}
936 	return (gpio);
937 }
938 
939 static void
hdaa_local_patch_pin(struct hdaa_widget * w)940 hdaa_local_patch_pin(struct hdaa_widget *w)
941 {
942 	device_t dev = w->devinfo->dev;
943 	const char *res = NULL;
944 	uint32_t config, orig;
945 	char buf[32];
946 
947 	config = orig = w->wclass.pin.config;
948 	snprintf(buf, sizeof(buf), "cad%u.nid%u.config",
949 	    hda_get_codec_id(dev), w->nid);
950 	if (resource_string_value(device_get_name(
951 	    device_get_parent(device_get_parent(dev))),
952 	    device_get_unit(device_get_parent(device_get_parent(dev))),
953 	    buf, &res) == 0) {
954 		if (strncmp(res, "0x", 2) == 0) {
955 			config = strtol(res + 2, NULL, 16);
956 		} else {
957 			config = hdaa_widget_pin_patch(config, res);
958 		}
959 	}
960 	snprintf(buf, sizeof(buf), "nid%u.config", w->nid);
961 	if (resource_string_value(device_get_name(dev), device_get_unit(dev),
962 	    buf, &res) == 0) {
963 		if (strncmp(res, "0x", 2) == 0) {
964 			config = strtol(res + 2, NULL, 16);
965 		} else {
966 			config = hdaa_widget_pin_patch(config, res);
967 		}
968 	}
969 	HDA_BOOTVERBOSE(
970 		if (config != orig)
971 			device_printf(w->devinfo->dev,
972 			    "Patching pin config nid=%u 0x%08x -> 0x%08x\n",
973 			    w->nid, orig, config);
974 	);
975 	w->wclass.pin.newconf = w->wclass.pin.config = config;
976 }
977 
978 static void
hdaa_dump_audio_formats_sb(struct sbuf * sb,uint32_t fcap,uint32_t pcmcap)979 hdaa_dump_audio_formats_sb(struct sbuf *sb, uint32_t fcap, uint32_t pcmcap)
980 {
981 	uint32_t cap;
982 
983 	cap = fcap;
984 	if (cap != 0) {
985 		sbuf_printf(sb, "     Stream cap: 0x%08x", cap);
986 		if (HDA_PARAM_SUPP_STREAM_FORMATS_AC3(cap))
987 			sbuf_printf(sb, " AC3");
988 		if (HDA_PARAM_SUPP_STREAM_FORMATS_FLOAT32(cap))
989 			sbuf_printf(sb, " FLOAT32");
990 		if (HDA_PARAM_SUPP_STREAM_FORMATS_PCM(cap))
991 			sbuf_printf(sb, " PCM");
992 		sbuf_printf(sb, "\n");
993 	}
994 	cap = pcmcap;
995 	if (cap != 0) {
996 		sbuf_printf(sb, "        PCM cap: 0x%08x", cap);
997 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_8BIT(cap))
998 			sbuf_printf(sb, " 8");
999 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_16BIT(cap))
1000 			sbuf_printf(sb, " 16");
1001 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_20BIT(cap))
1002 			sbuf_printf(sb, " 20");
1003 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_24BIT(cap))
1004 			sbuf_printf(sb, " 24");
1005 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_32BIT(cap))
1006 			sbuf_printf(sb, " 32");
1007 		sbuf_printf(sb, " bits,");
1008 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_8KHZ(cap))
1009 			sbuf_printf(sb, " 8");
1010 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_11KHZ(cap))
1011 			sbuf_printf(sb, " 11");
1012 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_16KHZ(cap))
1013 			sbuf_printf(sb, " 16");
1014 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_22KHZ(cap))
1015 			sbuf_printf(sb, " 22");
1016 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_32KHZ(cap))
1017 			sbuf_printf(sb, " 32");
1018 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_44KHZ(cap))
1019 			sbuf_printf(sb, " 44");
1020 		sbuf_printf(sb, " 48");
1021 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_88KHZ(cap))
1022 			sbuf_printf(sb, " 88");
1023 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_96KHZ(cap))
1024 			sbuf_printf(sb, " 96");
1025 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_176KHZ(cap))
1026 			sbuf_printf(sb, " 176");
1027 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_192KHZ(cap))
1028 			sbuf_printf(sb, " 192");
1029 		sbuf_printf(sb, " KHz\n");
1030 	}
1031 }
1032 
1033 static void
hdaa_dump_pin_sb(struct sbuf * sb,struct hdaa_widget * w)1034 hdaa_dump_pin_sb(struct sbuf *sb, struct hdaa_widget *w)
1035 {
1036 	uint32_t pincap, conf;
1037 
1038 	pincap = w->wclass.pin.cap;
1039 
1040 	sbuf_printf(sb, "        Pin cap: 0x%08x", pincap);
1041 	if (HDA_PARAM_PIN_CAP_IMP_SENSE_CAP(pincap))
1042 		sbuf_printf(sb, " ISC");
1043 	if (HDA_PARAM_PIN_CAP_TRIGGER_REQD(pincap))
1044 		sbuf_printf(sb, " TRQD");
1045 	if (HDA_PARAM_PIN_CAP_PRESENCE_DETECT_CAP(pincap))
1046 		sbuf_printf(sb, " PDC");
1047 	if (HDA_PARAM_PIN_CAP_HEADPHONE_CAP(pincap))
1048 		sbuf_printf(sb, " HP");
1049 	if (HDA_PARAM_PIN_CAP_OUTPUT_CAP(pincap))
1050 		sbuf_printf(sb, " OUT");
1051 	if (HDA_PARAM_PIN_CAP_INPUT_CAP(pincap))
1052 		sbuf_printf(sb, " IN");
1053 	if (HDA_PARAM_PIN_CAP_BALANCED_IO_PINS(pincap))
1054 		sbuf_printf(sb, " BAL");
1055 	if (HDA_PARAM_PIN_CAP_HDMI(pincap))
1056 		sbuf_printf(sb, " HDMI");
1057 	if (HDA_PARAM_PIN_CAP_VREF_CTRL(pincap)) {
1058 		sbuf_printf(sb, " VREF[");
1059 		if (HDA_PARAM_PIN_CAP_VREF_CTRL_50(pincap))
1060 			sbuf_printf(sb, " 50");
1061 		if (HDA_PARAM_PIN_CAP_VREF_CTRL_80(pincap))
1062 			sbuf_printf(sb, " 80");
1063 		if (HDA_PARAM_PIN_CAP_VREF_CTRL_100(pincap))
1064 			sbuf_printf(sb, " 100");
1065 		if (HDA_PARAM_PIN_CAP_VREF_CTRL_GROUND(pincap))
1066 			sbuf_printf(sb, " GROUND");
1067 		if (HDA_PARAM_PIN_CAP_VREF_CTRL_HIZ(pincap))
1068 			sbuf_printf(sb, " HIZ");
1069 		sbuf_printf(sb, " ]");
1070 	}
1071 	if (HDA_PARAM_PIN_CAP_EAPD_CAP(pincap))
1072 		sbuf_printf(sb, " EAPD");
1073 	if (HDA_PARAM_PIN_CAP_DP(pincap))
1074 		sbuf_printf(sb, " DP");
1075 	if (HDA_PARAM_PIN_CAP_HBR(pincap))
1076 		sbuf_printf(sb, " HBR");
1077 	sbuf_printf(sb, "\n");
1078 	conf = w->wclass.pin.config;
1079 	sbuf_printf(sb, "     Pin config: 0x%08x", conf);
1080 	sbuf_printf(sb, " as=%d seq=%d "
1081 	    "device=%s conn=%s ctype=%s loc=%s color=%s misc=%d\n",
1082 	    HDA_CONFIG_DEFAULTCONF_ASSOCIATION(conf),
1083 	    HDA_CONFIG_DEFAULTCONF_SEQUENCE(conf),
1084 	    HDA_DEVS[HDA_CONFIG_DEFAULTCONF_DEVICE(conf)],
1085 	    HDA_CONNS[HDA_CONFIG_DEFAULTCONF_CONNECTIVITY(conf)],
1086 	    HDA_CONNECTORS[HDA_CONFIG_DEFAULTCONF_CONNECTION_TYPE(conf)],
1087 	    HDA_LOCS[HDA_CONFIG_DEFAULTCONF_LOCATION(conf)],
1088 	    HDA_COLORS[HDA_CONFIG_DEFAULTCONF_COLOR(conf)],
1089 	    HDA_CONFIG_DEFAULTCONF_MISC(conf));
1090 	sbuf_printf(sb, "    Pin control: 0x%08x", w->wclass.pin.ctrl);
1091 	if (w->wclass.pin.ctrl & HDA_CMD_SET_PIN_WIDGET_CTRL_HPHN_ENABLE)
1092 		sbuf_printf(sb, " HP");
1093 	if (w->wclass.pin.ctrl & HDA_CMD_SET_PIN_WIDGET_CTRL_IN_ENABLE)
1094 		sbuf_printf(sb, " IN");
1095 	if (w->wclass.pin.ctrl & HDA_CMD_SET_PIN_WIDGET_CTRL_OUT_ENABLE)
1096 		sbuf_printf(sb, " OUT");
1097 	if (HDA_PARAM_AUDIO_WIDGET_CAP_DIGITAL(w->param.widget_cap)) {
1098 		if ((w->wclass.pin.ctrl &
1099 		    HDA_CMD_SET_PIN_WIDGET_CTRL_VREF_ENABLE_MASK) == 0x03)
1100 			sbuf_printf(sb, " HBR");
1101 		else if ((w->wclass.pin.ctrl &
1102 		    HDA_CMD_SET_PIN_WIDGET_CTRL_VREF_ENABLE_MASK) != 0)
1103 			sbuf_printf(sb, " EPTs");
1104 	} else {
1105 		if ((w->wclass.pin.ctrl &
1106 		    HDA_CMD_SET_PIN_WIDGET_CTRL_VREF_ENABLE_MASK) != 0)
1107 			sbuf_printf(sb, " VREFs");
1108 	}
1109 	sbuf_printf(sb, "\n");
1110 }
1111 
1112 static void
hdaa_dump_amp_sb(struct sbuf * sb,uint32_t cap,const char * banner)1113 hdaa_dump_amp_sb(struct sbuf *sb, uint32_t cap, const char *banner)
1114 {
1115 	int offset, size, step;
1116 
1117 	offset = HDA_PARAM_OUTPUT_AMP_CAP_OFFSET(cap);
1118 	size = HDA_PARAM_OUTPUT_AMP_CAP_STEPSIZE(cap);
1119 	step = HDA_PARAM_OUTPUT_AMP_CAP_NUMSTEPS(cap);
1120 	sbuf_printf(sb, "     %s amp: 0x%08x "
1121 	    "mute=%d step=%d size=%d offset=%d (%+d/%+ddB)\n",
1122 	    banner, cap,
1123 	    HDA_PARAM_OUTPUT_AMP_CAP_MUTE_CAP(cap),
1124 	    step, size, offset,
1125 	    ((0 - offset) * (size + 1)) / 4,
1126 	    ((step - offset) * (size + 1)) / 4);
1127 }
1128 
1129 static int
hdaa_sysctl_caps(SYSCTL_HANDLER_ARGS)1130 hdaa_sysctl_caps(SYSCTL_HANDLER_ARGS)
1131 {
1132 	struct hdaa_devinfo *devinfo;
1133 	struct hdaa_widget *w, *cw;
1134 	struct sbuf sb;
1135 	char buf[64];
1136 	int error, j;
1137 
1138 	w = (struct hdaa_widget *)oidp->oid_arg1;
1139 	devinfo = w->devinfo;
1140 	sbuf_new_for_sysctl(&sb, NULL, 256, req);
1141 
1142 	sbuf_printf(&sb, "%s%s\n", w->name,
1143 	    (w->enable == 0) ? " [DISABLED]" : "");
1144 	sbuf_printf(&sb, "     Widget cap: 0x%08x",
1145 	    w->param.widget_cap);
1146 	if (w->param.widget_cap & 0x0ee1) {
1147 		if (HDA_PARAM_AUDIO_WIDGET_CAP_LR_SWAP(w->param.widget_cap))
1148 		    sbuf_printf(&sb, " LRSWAP");
1149 		if (HDA_PARAM_AUDIO_WIDGET_CAP_POWER_CTRL(w->param.widget_cap))
1150 		    sbuf_printf(&sb, " PWR");
1151 		if (HDA_PARAM_AUDIO_WIDGET_CAP_DIGITAL(w->param.widget_cap))
1152 		    sbuf_printf(&sb, " DIGITAL");
1153 		if (HDA_PARAM_AUDIO_WIDGET_CAP_UNSOL_CAP(w->param.widget_cap))
1154 		    sbuf_printf(&sb, " UNSOL");
1155 		if (HDA_PARAM_AUDIO_WIDGET_CAP_PROC_WIDGET(w->param.widget_cap))
1156 		    sbuf_printf(&sb, " PROC");
1157 		if (HDA_PARAM_AUDIO_WIDGET_CAP_STRIPE(w->param.widget_cap))
1158 		    sbuf_printf(&sb, " STRIPE(x%d)",
1159 			1 << (fls(w->wclass.conv.stripecap) - 1));
1160 		j = HDA_PARAM_AUDIO_WIDGET_CAP_CC(w->param.widget_cap);
1161 		if (j == 1)
1162 		    sbuf_printf(&sb, " STEREO");
1163 		else if (j > 1)
1164 		    sbuf_printf(&sb, " %dCH", j + 1);
1165 	}
1166 	sbuf_printf(&sb, "\n");
1167 	if (w->bindas != -1) {
1168 		sbuf_printf(&sb, "    Association: %d (0x%04x)\n",
1169 		    w->bindas, w->bindseqmask);
1170 	}
1171 	if (w->ossmask != 0 || w->ossdev >= 0) {
1172 		sbuf_printf(&sb, "            OSS: %s",
1173 		    hdaa_audio_ctl_ossmixer_mask2allname(w->ossmask, buf, sizeof(buf)));
1174 		if (w->ossdev >= 0)
1175 		    sbuf_printf(&sb, " (%s)", ossnames[w->ossdev]);
1176 		sbuf_printf(&sb, "\n");
1177 	}
1178 	if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_OUTPUT ||
1179 	    w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_INPUT) {
1180 		hdaa_dump_audio_formats_sb(&sb,
1181 		    w->param.supp_stream_formats,
1182 		    w->param.supp_pcm_size_rate);
1183 	} else if (w->type ==
1184 	    HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX || w->waspin)
1185 		hdaa_dump_pin_sb(&sb, w);
1186 	if (w->param.eapdbtl != HDA_INVALID) {
1187 		sbuf_printf(&sb, "           EAPD: 0x%08x%s%s%s\n",
1188 		    w->param.eapdbtl,
1189 		    (w->param.eapdbtl & HDA_CMD_SET_EAPD_BTL_ENABLE_LR_SWAP) ?
1190 		     " LRSWAP" : "",
1191 		    (w->param.eapdbtl & HDA_CMD_SET_EAPD_BTL_ENABLE_EAPD) ?
1192 		     " EAPD" : "",
1193 		    (w->param.eapdbtl & HDA_CMD_SET_EAPD_BTL_ENABLE_BTL) ?
1194 		     " BTL" : "");
1195 	}
1196 	if (HDA_PARAM_AUDIO_WIDGET_CAP_OUT_AMP(w->param.widget_cap) &&
1197 	    w->param.outamp_cap != 0)
1198 		hdaa_dump_amp_sb(&sb, w->param.outamp_cap, "Output");
1199 	if (HDA_PARAM_AUDIO_WIDGET_CAP_IN_AMP(w->param.widget_cap) &&
1200 	    w->param.inamp_cap != 0)
1201 		hdaa_dump_amp_sb(&sb, w->param.inamp_cap, " Input");
1202 	if (w->nconns > 0)
1203 		sbuf_printf(&sb, "    Connections: %d\n", w->nconns);
1204 	for (j = 0; j < w->nconns; j++) {
1205 		cw = hdaa_widget_get(devinfo, w->conns[j]);
1206 		sbuf_printf(&sb, "          + %s<- nid=%d [%s]",
1207 		    (w->connsenable[j] == 0)?"[DISABLED] ":"",
1208 		    w->conns[j], (cw == NULL) ? "GHOST!" : cw->name);
1209 		if (cw == NULL)
1210 			sbuf_printf(&sb, " [UNKNOWN]");
1211 		else if (cw->enable == 0)
1212 			sbuf_printf(&sb, " [DISABLED]");
1213 		if (w->nconns > 1 && w->selconn == j && w->type !=
1214 		    HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_MIXER)
1215 			sbuf_printf(&sb, " (selected)");
1216 		sbuf_printf(&sb, "\n");
1217 	}
1218 	error = sbuf_finish(&sb);
1219 	sbuf_delete(&sb);
1220 	return (error);
1221 }
1222 
1223 static int
hdaa_sysctl_config(SYSCTL_HANDLER_ARGS)1224 hdaa_sysctl_config(SYSCTL_HANDLER_ARGS)
1225 {
1226 	char buf[256];
1227 	int error;
1228 	uint32_t conf;
1229 
1230 	conf = *(uint32_t *)oidp->oid_arg1;
1231 	snprintf(buf, sizeof(buf), "0x%08x as=%d seq=%d "
1232 	    "device=%s conn=%s ctype=%s loc=%s color=%s misc=%d",
1233 	    conf,
1234 	    HDA_CONFIG_DEFAULTCONF_ASSOCIATION(conf),
1235 	    HDA_CONFIG_DEFAULTCONF_SEQUENCE(conf),
1236 	    HDA_DEVS[HDA_CONFIG_DEFAULTCONF_DEVICE(conf)],
1237 	    HDA_CONNS[HDA_CONFIG_DEFAULTCONF_CONNECTIVITY(conf)],
1238 	    HDA_CONNECTORS[HDA_CONFIG_DEFAULTCONF_CONNECTION_TYPE(conf)],
1239 	    HDA_LOCS[HDA_CONFIG_DEFAULTCONF_LOCATION(conf)],
1240 	    HDA_COLORS[HDA_CONFIG_DEFAULTCONF_COLOR(conf)],
1241 	    HDA_CONFIG_DEFAULTCONF_MISC(conf));
1242 	error = sysctl_handle_string(oidp, buf, sizeof(buf), req);
1243 	if (error != 0 || req->newptr == NULL)
1244 		return (error);
1245 	if (strncmp(buf, "0x", 2) == 0)
1246 		conf = strtol(buf + 2, NULL, 16);
1247 	else
1248 		conf = hdaa_widget_pin_patch(conf, buf);
1249 	*(uint32_t *)oidp->oid_arg1 = conf;
1250 	return (0);
1251 }
1252 
1253 static void
hdaa_config_fetch(const char * str,uint32_t * on,uint32_t * off)1254 hdaa_config_fetch(const char *str, uint32_t *on, uint32_t *off)
1255 {
1256 	size_t k;
1257 	int i = 0, j, len, inv;
1258 
1259 	for (;;) {
1260 		while (str[i] != '\0' &&
1261 		    (str[i] == ',' || isspace(str[i]) != 0))
1262 			i++;
1263 		if (str[i] == '\0')
1264 			return;
1265 		j = i;
1266 		while (str[j] != '\0' &&
1267 		    !(str[j] == ',' || isspace(str[j]) != 0))
1268 			j++;
1269 		len = j - i;
1270 		if (len > 2 && strncmp(str + i, "no", 2) == 0)
1271 			inv = 2;
1272 		else
1273 			inv = 0;
1274 		for (k = 0; len > inv && k < nitems(hdaa_quirks_tab); k++) {
1275 			if (strncmp(str + i + inv,
1276 			    hdaa_quirks_tab[k].key, len - inv) != 0)
1277 				continue;
1278 			if (len - inv != strlen(hdaa_quirks_tab[k].key))
1279 				continue;
1280 			if (inv == 0) {
1281 				*on |= hdaa_quirks_tab[k].value;
1282 				*off &= ~hdaa_quirks_tab[k].value;
1283 			} else {
1284 				*off |= hdaa_quirks_tab[k].value;
1285 				*on &= ~hdaa_quirks_tab[k].value;
1286 			}
1287 			break;
1288 		}
1289 		i = j;
1290 	}
1291 }
1292 
1293 static int
hdaa_sysctl_quirks(SYSCTL_HANDLER_ARGS)1294 hdaa_sysctl_quirks(SYSCTL_HANDLER_ARGS)
1295 {
1296 	char buf[256];
1297 	int error, n = 0;
1298 	size_t i;
1299 	uint32_t quirks, quirks_off;
1300 
1301 	quirks = *(uint32_t *)oidp->oid_arg1;
1302 	buf[0] = 0;
1303 	for (i = 0; i < nitems(hdaa_quirks_tab); i++) {
1304 		if ((quirks & hdaa_quirks_tab[i].value) != 0)
1305 			n += snprintf(buf + n, sizeof(buf) - n, "%s%s",
1306 			    n != 0 ? "," : "", hdaa_quirks_tab[i].key);
1307 	}
1308 	error = sysctl_handle_string(oidp, buf, sizeof(buf), req);
1309 	if (error != 0 || req->newptr == NULL)
1310 		return (error);
1311 	if (strncmp(buf, "0x", 2) == 0)
1312 		quirks = strtol(buf + 2, NULL, 16);
1313 	else {
1314 		quirks = 0;
1315 		hdaa_config_fetch(buf, &quirks, &quirks_off);
1316 	}
1317 	*(uint32_t *)oidp->oid_arg1 = quirks;
1318 	return (0);
1319 }
1320 
1321 static void
hdaa_local_patch(struct hdaa_devinfo * devinfo)1322 hdaa_local_patch(struct hdaa_devinfo *devinfo)
1323 {
1324 	struct hdaa_widget *w;
1325 	const char *res = NULL;
1326 	uint32_t quirks_on = 0, quirks_off = 0, x;
1327 	int i;
1328 
1329 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
1330 		w = hdaa_widget_get(devinfo, i);
1331 		if (w == NULL)
1332 			continue;
1333 		if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
1334 			hdaa_local_patch_pin(w);
1335 	}
1336 
1337 	if (resource_string_value(device_get_name(devinfo->dev),
1338 	    device_get_unit(devinfo->dev), "config", &res) == 0) {
1339 		if (res != NULL && strlen(res) > 0)
1340 			hdaa_config_fetch(res, &quirks_on, &quirks_off);
1341 		devinfo->quirks |= quirks_on;
1342 		devinfo->quirks &= ~quirks_off;
1343 	}
1344 	if (devinfo->newquirks == -1)
1345 		devinfo->newquirks = devinfo->quirks;
1346 	else
1347 		devinfo->quirks = devinfo->newquirks;
1348 	HDA_BOOTHVERBOSE(
1349 		device_printf(devinfo->dev,
1350 		    "Config options: 0x%08x\n", devinfo->quirks);
1351 	);
1352 
1353 	if (resource_string_value(device_get_name(devinfo->dev),
1354 	    device_get_unit(devinfo->dev), "gpio_config", &res) == 0) {
1355 		if (strncmp(res, "0x", 2) == 0) {
1356 			devinfo->gpio = strtol(res + 2, NULL, 16);
1357 		} else {
1358 			devinfo->gpio = hdaa_gpio_patch(devinfo->gpio, res);
1359 		}
1360 	}
1361 	if (devinfo->newgpio == -1)
1362 		devinfo->newgpio = devinfo->gpio;
1363 	else
1364 		devinfo->gpio = devinfo->newgpio;
1365 	if (devinfo->newgpo == -1)
1366 		devinfo->newgpo = devinfo->gpo;
1367 	else
1368 		devinfo->gpo = devinfo->newgpo;
1369 	HDA_BOOTHVERBOSE(
1370 		device_printf(devinfo->dev, "GPIO config options:");
1371 		for (i = 0; i < 7; i++) {
1372 			x = (devinfo->gpio & HDAA_GPIO_MASK(i)) >> HDAA_GPIO_SHIFT(i);
1373 			if (x != 0)
1374 				printf(" %d=%s", i, HDA_GPIO_ACTIONS[x]);
1375 		}
1376 		printf("\n");
1377 	);
1378 }
1379 
1380 static void
hdaa_widget_connection_parse(struct hdaa_widget * w)1381 hdaa_widget_connection_parse(struct hdaa_widget *w)
1382 {
1383 	uint32_t res;
1384 	int i, j, max, ents, entnum;
1385 	nid_t nid = w->nid;
1386 	nid_t cnid, addcnid, prevcnid;
1387 
1388 	w->nconns = 0;
1389 
1390 	res = hda_command(w->devinfo->dev,
1391 	    HDA_CMD_GET_PARAMETER(0, nid, HDA_PARAM_CONN_LIST_LENGTH));
1392 
1393 	ents = HDA_PARAM_CONN_LIST_LENGTH_LIST_LENGTH(res);
1394 
1395 	if (ents < 1)
1396 		return;
1397 
1398 	entnum = HDA_PARAM_CONN_LIST_LENGTH_LONG_FORM(res) ? 2 : 4;
1399 	max = (sizeof(w->conns) / sizeof(w->conns[0])) - 1;
1400 	prevcnid = 0;
1401 
1402 #define CONN_RMASK(e)		(1 << ((32 / (e)) - 1))
1403 #define CONN_NMASK(e)		(CONN_RMASK(e) - 1)
1404 #define CONN_RESVAL(r, e, n)	((r) >> ((32 / (e)) * (n)))
1405 #define CONN_RANGE(r, e, n)	(CONN_RESVAL(r, e, n) & CONN_RMASK(e))
1406 #define CONN_CNID(r, e, n)	(CONN_RESVAL(r, e, n) & CONN_NMASK(e))
1407 
1408 	for (i = 0; i < ents; i += entnum) {
1409 		res = hda_command(w->devinfo->dev,
1410 		    HDA_CMD_GET_CONN_LIST_ENTRY(0, nid, i));
1411 		for (j = 0; j < entnum; j++) {
1412 			cnid = CONN_CNID(res, entnum, j);
1413 			if (cnid == 0) {
1414 				if (w->nconns < ents)
1415 					device_printf(w->devinfo->dev,
1416 					    "WARNING: nid=%d has zero cnid "
1417 					    "entnum=%d j=%d index=%d "
1418 					    "entries=%d found=%d res=0x%08x\n",
1419 					    nid, entnum, j, i,
1420 					    ents, w->nconns, res);
1421 				else
1422 					goto getconns_out;
1423 			}
1424 			if (cnid < w->devinfo->startnode ||
1425 			    cnid >= w->devinfo->endnode) {
1426 				HDA_BOOTVERBOSE(
1427 					device_printf(w->devinfo->dev,
1428 					    "WARNING: nid=%d has cnid outside "
1429 					    "of the AFG range j=%d "
1430 					    "entnum=%d index=%d res=0x%08x\n",
1431 					    nid, j, entnum, i, res);
1432 				);
1433 			}
1434 			if (CONN_RANGE(res, entnum, j) == 0)
1435 				addcnid = cnid;
1436 			else if (prevcnid == 0 || prevcnid >= cnid) {
1437 				device_printf(w->devinfo->dev,
1438 				    "WARNING: Invalid child range "
1439 				    "nid=%d index=%d j=%d entnum=%d "
1440 				    "prevcnid=%d cnid=%d res=0x%08x\n",
1441 				    nid, i, j, entnum, prevcnid,
1442 				    cnid, res);
1443 				addcnid = cnid;
1444 			} else
1445 				addcnid = prevcnid + 1;
1446 			while (addcnid <= cnid) {
1447 				if (w->nconns > max) {
1448 					device_printf(w->devinfo->dev,
1449 					    "Adding %d (nid=%d): "
1450 					    "Max connection reached! max=%d\n",
1451 					    addcnid, nid, max + 1);
1452 					goto getconns_out;
1453 				}
1454 				w->connsenable[w->nconns] = 1;
1455 				w->conns[w->nconns++] = addcnid++;
1456 			}
1457 			prevcnid = cnid;
1458 		}
1459 	}
1460 
1461 getconns_out:
1462 	return;
1463 }
1464 
1465 static void
hdaa_widget_parse(struct hdaa_widget * w)1466 hdaa_widget_parse(struct hdaa_widget *w)
1467 {
1468 	device_t dev = w->devinfo->dev;
1469 	uint32_t wcap, cap;
1470 	nid_t nid = w->nid;
1471 	char buf[64];
1472 
1473 	w->param.widget_cap = wcap = hda_command(dev,
1474 	    HDA_CMD_GET_PARAMETER(0, nid, HDA_PARAM_AUDIO_WIDGET_CAP));
1475 	w->type = HDA_PARAM_AUDIO_WIDGET_CAP_TYPE(wcap);
1476 
1477 	hdaa_widget_connection_parse(w);
1478 
1479 	if (HDA_PARAM_AUDIO_WIDGET_CAP_OUT_AMP(wcap)) {
1480 		if (HDA_PARAM_AUDIO_WIDGET_CAP_AMP_OVR(wcap))
1481 			w->param.outamp_cap =
1482 			    hda_command(dev,
1483 			    HDA_CMD_GET_PARAMETER(0, nid,
1484 			    HDA_PARAM_OUTPUT_AMP_CAP));
1485 		else
1486 			w->param.outamp_cap =
1487 			    w->devinfo->outamp_cap;
1488 	} else
1489 		w->param.outamp_cap = 0;
1490 
1491 	if (HDA_PARAM_AUDIO_WIDGET_CAP_IN_AMP(wcap)) {
1492 		if (HDA_PARAM_AUDIO_WIDGET_CAP_AMP_OVR(wcap))
1493 			w->param.inamp_cap =
1494 			    hda_command(dev,
1495 			    HDA_CMD_GET_PARAMETER(0, nid,
1496 			    HDA_PARAM_INPUT_AMP_CAP));
1497 		else
1498 			w->param.inamp_cap =
1499 			    w->devinfo->inamp_cap;
1500 	} else
1501 		w->param.inamp_cap = 0;
1502 
1503 	if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_OUTPUT ||
1504 	    w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_INPUT) {
1505 		if (HDA_PARAM_AUDIO_WIDGET_CAP_FORMAT_OVR(wcap)) {
1506 			cap = hda_command(dev,
1507 			    HDA_CMD_GET_PARAMETER(0, nid,
1508 			    HDA_PARAM_SUPP_STREAM_FORMATS));
1509 			w->param.supp_stream_formats = (cap != 0) ? cap :
1510 			    w->devinfo->supp_stream_formats;
1511 			cap = hda_command(dev,
1512 			    HDA_CMD_GET_PARAMETER(0, nid,
1513 			    HDA_PARAM_SUPP_PCM_SIZE_RATE));
1514 			w->param.supp_pcm_size_rate = (cap != 0) ? cap :
1515 			    w->devinfo->supp_pcm_size_rate;
1516 		} else {
1517 			w->param.supp_stream_formats =
1518 			    w->devinfo->supp_stream_formats;
1519 			w->param.supp_pcm_size_rate =
1520 			    w->devinfo->supp_pcm_size_rate;
1521 		}
1522 		if (HDA_PARAM_AUDIO_WIDGET_CAP_STRIPE(w->param.widget_cap)) {
1523 			w->wclass.conv.stripecap = hda_command(dev,
1524 			    HDA_CMD_GET_STRIPE_CONTROL(0, w->nid)) >> 20;
1525 		} else
1526 			w->wclass.conv.stripecap = 1;
1527 	} else {
1528 		w->param.supp_stream_formats = 0;
1529 		w->param.supp_pcm_size_rate = 0;
1530 	}
1531 
1532 	if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX) {
1533 		w->wclass.pin.original = w->wclass.pin.newconf =
1534 		    w->wclass.pin.config = hda_command(dev,
1535 			HDA_CMD_GET_CONFIGURATION_DEFAULT(0, w->nid));
1536 		w->wclass.pin.cap = hda_command(dev,
1537 		    HDA_CMD_GET_PARAMETER(0, w->nid, HDA_PARAM_PIN_CAP));
1538 		w->wclass.pin.ctrl = hda_command(dev,
1539 		    HDA_CMD_GET_PIN_WIDGET_CTRL(0, nid));
1540 		w->wclass.pin.connected = 2;
1541 		if (HDA_PARAM_PIN_CAP_EAPD_CAP(w->wclass.pin.cap)) {
1542 			w->param.eapdbtl = hda_command(dev,
1543 			    HDA_CMD_GET_EAPD_BTL_ENABLE(0, nid));
1544 			w->param.eapdbtl &= 0x7;
1545 			w->param.eapdbtl |= HDA_CMD_SET_EAPD_BTL_ENABLE_EAPD;
1546 		} else
1547 			w->param.eapdbtl = HDA_INVALID;
1548 	}
1549 	w->unsol = -1;
1550 
1551 	hdaa_unlock(w->devinfo);
1552 	snprintf(buf, sizeof(buf), "nid%d", w->nid);
1553 	SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
1554 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO,
1555 	    buf, CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE,
1556 	    w, 0, hdaa_sysctl_caps, "A", "Node capabilities");
1557 	if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX) {
1558 		snprintf(buf, sizeof(buf), "nid%d_config", w->nid);
1559 		SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
1560 		    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO,
1561 		    buf, CTLTYPE_STRING | CTLFLAG_RW | CTLFLAG_MPSAFE,
1562 		    &w->wclass.pin.newconf, 0, hdaa_sysctl_config, "A",
1563 		    "Current pin configuration");
1564 		snprintf(buf, sizeof(buf), "nid%d_original", w->nid);
1565 		SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
1566 		    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO,
1567 		    buf, CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE,
1568 		    &w->wclass.pin.original, 0, hdaa_sysctl_config, "A",
1569 		    "Original pin configuration");
1570 	}
1571 	hdaa_lock(w->devinfo);
1572 }
1573 
1574 static void
hdaa_widget_postprocess(struct hdaa_widget * w)1575 hdaa_widget_postprocess(struct hdaa_widget *w)
1576 {
1577 	const char *typestr;
1578 
1579 	w->type = HDA_PARAM_AUDIO_WIDGET_CAP_TYPE(w->param.widget_cap);
1580 	switch (w->type) {
1581 	case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_OUTPUT:
1582 		typestr = "audio output";
1583 		break;
1584 	case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_INPUT:
1585 		typestr = "audio input";
1586 		break;
1587 	case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_MIXER:
1588 		typestr = "audio mixer";
1589 		break;
1590 	case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_SELECTOR:
1591 		typestr = "audio selector";
1592 		break;
1593 	case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX:
1594 		typestr = "pin";
1595 		break;
1596 	case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_POWER_WIDGET:
1597 		typestr = "power widget";
1598 		break;
1599 	case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_VOLUME_WIDGET:
1600 		typestr = "volume widget";
1601 		break;
1602 	case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_BEEP_WIDGET:
1603 		typestr = "beep widget";
1604 		break;
1605 	case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_VENDOR_WIDGET:
1606 		typestr = "vendor widget";
1607 		break;
1608 	default:
1609 		typestr = "unknown type";
1610 		break;
1611 	}
1612 	strlcpy(w->name, typestr, sizeof(w->name));
1613 
1614 	if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX) {
1615 		uint32_t config;
1616 		const char *devstr;
1617 		int conn, color;
1618 
1619 		config = w->wclass.pin.config;
1620 		devstr = HDA_DEVS[(config & HDA_CONFIG_DEFAULTCONF_DEVICE_MASK) >>
1621 		    HDA_CONFIG_DEFAULTCONF_DEVICE_SHIFT];
1622 		conn = (config & HDA_CONFIG_DEFAULTCONF_CONNECTIVITY_MASK) >>
1623 		    HDA_CONFIG_DEFAULTCONF_CONNECTIVITY_SHIFT;
1624 		color = (config & HDA_CONFIG_DEFAULTCONF_COLOR_MASK) >>
1625 		    HDA_CONFIG_DEFAULTCONF_COLOR_SHIFT;
1626 		strlcat(w->name, ": ", sizeof(w->name));
1627 		strlcat(w->name, devstr, sizeof(w->name));
1628 		strlcat(w->name, " (", sizeof(w->name));
1629 		if (conn == 0 && color != 0 && color != 15) {
1630 			strlcat(w->name, HDA_COLORS[color], sizeof(w->name));
1631 			strlcat(w->name, " ", sizeof(w->name));
1632 		}
1633 		strlcat(w->name, HDA_CONNS[conn], sizeof(w->name));
1634 		strlcat(w->name, ")", sizeof(w->name));
1635 	}
1636 }
1637 
1638 struct hdaa_widget *
hdaa_widget_get(struct hdaa_devinfo * devinfo,nid_t nid)1639 hdaa_widget_get(struct hdaa_devinfo *devinfo, nid_t nid)
1640 {
1641 	if (devinfo == NULL || devinfo->widget == NULL ||
1642 		    nid < devinfo->startnode || nid >= devinfo->endnode)
1643 		return (NULL);
1644 	return (&devinfo->widget[nid - devinfo->startnode]);
1645 }
1646 
1647 static void
hdaa_audio_ctl_amp_set_internal(struct hdaa_devinfo * devinfo,nid_t nid,int index,int lmute,int rmute,int left,int right,int dir)1648 hdaa_audio_ctl_amp_set_internal(struct hdaa_devinfo *devinfo, nid_t nid,
1649 					int index, int lmute, int rmute,
1650 					int left, int right, int dir)
1651 {
1652 	uint16_t v = 0;
1653 
1654 	HDA_BOOTHVERBOSE(
1655 		device_printf(devinfo->dev,
1656 		    "Setting amplifier nid=%d index=%d %s mute=%d/%d vol=%d/%d\n",
1657 		    nid,index,dir ? "in" : "out",lmute,rmute,left,right);
1658 	);
1659 	if (left != right || lmute != rmute) {
1660 		v = (1 << (15 - dir)) | (1 << 13) | (index << 8) |
1661 		    (lmute << 7) | left;
1662 		hda_command(devinfo->dev,
1663 		    HDA_CMD_SET_AMP_GAIN_MUTE(0, nid, v));
1664 		v = (1 << (15 - dir)) | (1 << 12) | (index << 8) |
1665 		    (rmute << 7) | right;
1666 	} else
1667 		v = (1 << (15 - dir)) | (3 << 12) | (index << 8) |
1668 		    (lmute << 7) | left;
1669 
1670 	hda_command(devinfo->dev,
1671 	    HDA_CMD_SET_AMP_GAIN_MUTE(0, nid, v));
1672 }
1673 
1674 static void
hdaa_audio_ctl_amp_set(struct hdaa_audio_ctl * ctl,uint32_t mute,int left,int right)1675 hdaa_audio_ctl_amp_set(struct hdaa_audio_ctl *ctl, uint32_t mute,
1676 						int left, int right)
1677 {
1678 	nid_t nid;
1679 	int lmute, rmute;
1680 
1681 	nid = ctl->widget->nid;
1682 
1683 	/* Save new values if valid. */
1684 	if (mute != HDAA_AMP_MUTE_DEFAULT)
1685 		ctl->muted = mute;
1686 	if (left != HDAA_AMP_VOL_DEFAULT)
1687 		ctl->left = left;
1688 	if (right != HDAA_AMP_VOL_DEFAULT)
1689 		ctl->right = right;
1690 	/* Prepare effective values */
1691 	if (ctl->forcemute) {
1692 		lmute = 1;
1693 		rmute = 1;
1694 		left = 0;
1695 		right = 0;
1696 	} else {
1697 		lmute = HDAA_AMP_LEFT_MUTED(ctl->muted);
1698 		rmute = HDAA_AMP_RIGHT_MUTED(ctl->muted);
1699 		left = ctl->left;
1700 		right = ctl->right;
1701 	}
1702 	/* Apply effective values */
1703 	if (ctl->dir & HDAA_CTL_OUT)
1704 		hdaa_audio_ctl_amp_set_internal(ctl->widget->devinfo, nid, ctl->index,
1705 		    lmute, rmute, left, right, 0);
1706 	if (ctl->dir & HDAA_CTL_IN)
1707 		hdaa_audio_ctl_amp_set_internal(ctl->widget->devinfo, nid, ctl->index,
1708 		    lmute, rmute, left, right, 1);
1709 }
1710 
1711 static void
hdaa_widget_connection_select(struct hdaa_widget * w,uint8_t index)1712 hdaa_widget_connection_select(struct hdaa_widget *w, uint8_t index)
1713 {
1714 	if (w == NULL || w->nconns < 1 || index > (w->nconns - 1))
1715 		return;
1716 	HDA_BOOTHVERBOSE(
1717 		device_printf(w->devinfo->dev,
1718 		    "Setting selector nid=%d index=%d\n", w->nid, index);
1719 	);
1720 	hda_command(w->devinfo->dev,
1721 	    HDA_CMD_SET_CONNECTION_SELECT_CONTROL(0, w->nid, index));
1722 	w->selconn = index;
1723 }
1724 
1725 /****************************************************************************
1726  * Device Methods
1727  ****************************************************************************/
1728 
1729 static void *
hdaa_channel_init(kobj_t obj,void * data,struct snd_dbuf * b,struct pcm_channel * c,int dir)1730 hdaa_channel_init(kobj_t obj, void *data, struct snd_dbuf *b,
1731 					struct pcm_channel *c, int dir)
1732 {
1733 	struct hdaa_chan *ch = data;
1734 	struct hdaa_pcm_devinfo *pdevinfo = ch->pdevinfo;
1735 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
1736 
1737 	hdaa_lock(devinfo);
1738 	if (devinfo->quirks & HDAA_QUIRK_FIXEDRATE) {
1739 		ch->caps.minspeed = ch->caps.maxspeed = 48000;
1740 		ch->pcmrates[0] = 48000;
1741 		ch->pcmrates[1] = 0;
1742 	}
1743 	ch->dir = dir;
1744 	ch->b = b;
1745 	ch->c = c;
1746 	ch->blksz = pdevinfo->chan_size / pdevinfo->chan_blkcnt;
1747 	ch->blkcnt = pdevinfo->chan_blkcnt;
1748 	hdaa_unlock(devinfo);
1749 
1750 	if (sndbuf_alloc(ch->b, bus_get_dma_tag(devinfo->dev),
1751 	    hda_get_dma_nocache(devinfo->dev) ? BUS_DMA_NOCACHE :
1752 	    BUS_DMA_COHERENT,
1753 	    pdevinfo->chan_size) != 0)
1754 		return (NULL);
1755 
1756 	return (ch);
1757 }
1758 
1759 static int
hdaa_channel_setformat(kobj_t obj,void * data,uint32_t format)1760 hdaa_channel_setformat(kobj_t obj, void *data, uint32_t format)
1761 {
1762 	struct hdaa_chan *ch = data;
1763 	int i;
1764 
1765 	for (i = 0; ch->caps.fmtlist[i] != 0; i++) {
1766 		if (format == ch->caps.fmtlist[i]) {
1767 			ch->fmt = format;
1768 			return (0);
1769 		}
1770 	}
1771 
1772 	return (EINVAL);
1773 }
1774 
1775 static uint32_t
hdaa_channel_setspeed(kobj_t obj,void * data,uint32_t speed)1776 hdaa_channel_setspeed(kobj_t obj, void *data, uint32_t speed)
1777 {
1778 	struct hdaa_chan *ch = data;
1779 	uint32_t spd = 0, threshold;
1780 	int i;
1781 
1782 	/* First look for equal or multiple frequency. */
1783 	for (i = 0; ch->pcmrates[i] != 0; i++) {
1784 		spd = ch->pcmrates[i];
1785 		if (speed != 0 && spd / speed * speed == spd) {
1786 			ch->spd = spd;
1787 			return (spd);
1788 		}
1789 	}
1790 	/* If no match, just find nearest. */
1791 	for (i = 0; ch->pcmrates[i] != 0; i++) {
1792 		spd = ch->pcmrates[i];
1793 		threshold = spd + ((ch->pcmrates[i + 1] != 0) ?
1794 		    ((ch->pcmrates[i + 1] - spd) >> 1) : 0);
1795 		if (speed < threshold)
1796 			break;
1797 	}
1798 	ch->spd = spd;
1799 	return (spd);
1800 }
1801 
1802 static uint16_t
hdaa_stream_format(struct hdaa_chan * ch)1803 hdaa_stream_format(struct hdaa_chan *ch)
1804 {
1805 	int i;
1806 	uint16_t fmt;
1807 
1808 	fmt = 0;
1809 	if (ch->fmt & AFMT_S16_LE)
1810 		fmt |= ch->bit16 << 4;
1811 	else if (ch->fmt & AFMT_S32_LE)
1812 		fmt |= ch->bit32 << 4;
1813 	else
1814 		fmt |= 1 << 4;
1815 	for (i = 0; i < HDA_RATE_TAB_LEN; i++) {
1816 		if (hda_rate_tab[i].valid && ch->spd == hda_rate_tab[i].rate) {
1817 			fmt |= hda_rate_tab[i].base;
1818 			fmt |= hda_rate_tab[i].mul;
1819 			fmt |= hda_rate_tab[i].div;
1820 			break;
1821 		}
1822 	}
1823 	fmt |= (AFMT_CHANNEL(ch->fmt) - 1);
1824 
1825 	return (fmt);
1826 }
1827 
1828 static int
hdaa_allowed_stripes(uint16_t fmt)1829 hdaa_allowed_stripes(uint16_t fmt)
1830 {
1831 	static const int bits[8] = { 8, 16, 20, 24, 32, 32, 32, 32 };
1832 	int size;
1833 
1834 	size = bits[(fmt >> 4) & 0x03];
1835 	size *= (fmt & 0x0f) + 1;
1836 	size *= ((fmt >> 11) & 0x07) + 1;
1837 	return (0xffffffffU >> (32 - fls(size / 8)));
1838 }
1839 
1840 static void
hdaa_audio_setup(struct hdaa_chan * ch)1841 hdaa_audio_setup(struct hdaa_chan *ch)
1842 {
1843 	struct hdaa_audio_as *as = &ch->devinfo->as[ch->as];
1844 	struct hdaa_widget *w, *wp;
1845 	int i, j, k, chn, cchn, totalchn, totalextchn, c;
1846 	uint16_t fmt, dfmt;
1847 	/* Mapping channel pairs to codec pins/converters. */
1848 	const static uint16_t convmap[2][5] =
1849 	    /*  1.0     2.0     4.0     5.1     7.1  */
1850 	    {{ 0x0010, 0x0001, 0x0201, 0x0231, 0x4231 },	/* no dup. */
1851 	     { 0x0010, 0x0001, 0x2201, 0x2231, 0x4231 }};	/* side dup. */
1852 	/* Mapping formats to HDMI channel allocations. */
1853 	const static uint8_t hdmica[2][8] =
1854 	    /*  1     2     3     4     5     6     7     8  */
1855 	    {{ 0x02, 0x00, 0x04, 0x08, 0x0a, 0x0e, 0x12, 0x12 }, /* x.0 */
1856 	     { 0x01, 0x03, 0x01, 0x03, 0x09, 0x0b, 0x0f, 0x13 }}; /* x.1 */
1857 	/* Mapping formats to HDMI channels order. */
1858 	const static uint32_t hdmich[2][8] =
1859 	    /*  1  /  5     2  /  6     3  /  7     4  /  8  */
1860 	    {{ 0xFFFF0F00, 0xFFFFFF10, 0xFFF2FF10, 0xFF32FF10,
1861 	       0xFF324F10, 0xF5324F10, 0x54326F10, 0x54326F10 }, /* x.0 */
1862 	     { 0xFFFFF000, 0xFFFF0100, 0xFFFFF210, 0xFFFF2310,
1863 	       0xFF32F410, 0xFF324510, 0xF6324510, 0x76325410 }}; /* x.1 */
1864 	int convmapid = -1;
1865 	nid_t nid;
1866 	uint8_t csum;
1867 
1868 	totalchn = AFMT_CHANNEL(ch->fmt);
1869 	totalextchn = AFMT_EXTCHANNEL(ch->fmt);
1870 	HDA_BOOTHVERBOSE(
1871 		device_printf(ch->pdevinfo->dev,
1872 		    "PCMDIR_%s: Stream setup fmt=%08x (%d.%d) speed=%d\n",
1873 		    (ch->dir == PCMDIR_PLAY) ? "PLAY" : "REC",
1874 		    ch->fmt, totalchn - totalextchn, totalextchn, ch->spd);
1875 	);
1876 	fmt = hdaa_stream_format(ch);
1877 
1878 	/* Set channels to I/O converters mapping for known speaker setups. */
1879 	if ((as->pinset == 0x0007 || as->pinset == 0x0013) || /* Standard 5.1 */
1880 	    (as->pinset == 0x0017)) /* Standard 7.1 */
1881 		convmapid = (ch->dir == PCMDIR_PLAY);
1882 
1883 	dfmt = HDA_CMD_SET_DIGITAL_CONV_FMT1_DIGEN;
1884 	if (ch->fmt & AFMT_AC3)
1885 		dfmt |= HDA_CMD_SET_DIGITAL_CONV_FMT1_NAUDIO;
1886 
1887 	chn = 0;
1888 	for (i = 0; ch->io[i] != -1; i++) {
1889 		w = hdaa_widget_get(ch->devinfo, ch->io[i]);
1890 		if (w == NULL)
1891 			continue;
1892 
1893 		/* If HP redirection is enabled, but failed to use same
1894 		   DAC, make last DAC to duplicate first one. */
1895 		if (as->fakeredir && i == (as->pincnt - 1)) {
1896 			c = (ch->sid << 4);
1897 		} else {
1898 			/* Map channels to I/O converters, if set. */
1899 			if (convmapid >= 0)
1900 				chn = (((convmap[convmapid][totalchn / 2]
1901 				    >> i * 4) & 0xf) - 1) * 2;
1902 			if (chn < 0 || chn >= totalchn) {
1903 				c = 0;
1904 			} else {
1905 				c = (ch->sid << 4) | chn;
1906 			}
1907 		}
1908 		hda_command(ch->devinfo->dev,
1909 		    HDA_CMD_SET_CONV_FMT(0, ch->io[i], fmt));
1910 		if (HDA_PARAM_AUDIO_WIDGET_CAP_DIGITAL(w->param.widget_cap)) {
1911 			hda_command(ch->devinfo->dev,
1912 			    HDA_CMD_SET_DIGITAL_CONV_FMT1(0, ch->io[i], dfmt));
1913 		}
1914 		hda_command(ch->devinfo->dev,
1915 		    HDA_CMD_SET_CONV_STREAM_CHAN(0, ch->io[i], c));
1916 		if (HDA_PARAM_AUDIO_WIDGET_CAP_STRIPE(w->param.widget_cap)) {
1917 			hda_command(ch->devinfo->dev,
1918 			    HDA_CMD_SET_STRIPE_CONTROL(0, w->nid, ch->stripectl));
1919 		}
1920 		cchn = HDA_PARAM_AUDIO_WIDGET_CAP_CC(w->param.widget_cap);
1921 		if (cchn > 1 && chn < totalchn) {
1922 			cchn = min(cchn, totalchn - chn - 1);
1923 			hda_command(ch->devinfo->dev,
1924 			    HDA_CMD_SET_CONV_CHAN_COUNT(0, ch->io[i], cchn));
1925 		}
1926 		HDA_BOOTHVERBOSE(
1927 			device_printf(ch->pdevinfo->dev,
1928 			    "PCMDIR_%s: Stream setup nid=%d: "
1929 			    "fmt=0x%04x, dfmt=0x%04x, chan=0x%04x, "
1930 			    "chan_count=0x%02x, stripe=%d\n",
1931 			    (ch->dir == PCMDIR_PLAY) ? "PLAY" : "REC",
1932 			    ch->io[i], fmt, dfmt, c, cchn, ch->stripectl);
1933 		);
1934 		for (j = 0; j < 16; j++) {
1935 			if (as->dacs[ch->asindex][j] != ch->io[i])
1936 				continue;
1937 			nid = as->pins[j];
1938 			wp = hdaa_widget_get(ch->devinfo, nid);
1939 			if (wp == NULL)
1940 				continue;
1941 			if (!HDA_PARAM_PIN_CAP_DP(wp->wclass.pin.cap) &&
1942 			    !HDA_PARAM_PIN_CAP_HDMI(wp->wclass.pin.cap))
1943 				continue;
1944 
1945 			/* Set channel mapping. */
1946 			for (k = 0; k < 8; k++) {
1947 				hda_command(ch->devinfo->dev,
1948 				    HDA_CMD_SET_HDMI_CHAN_SLOT(0, nid,
1949 				    (((hdmich[totalextchn == 0 ? 0 : 1][totalchn - 1]
1950 				     >> (k * 4)) & 0xf) << 4) | k));
1951 			}
1952 
1953 			/*
1954 			 * Enable High Bit Rate (HBR) Encoded Packet Type
1955 			 * (EPT), if supported and needed (8ch data).
1956 			 */
1957 			if (HDA_PARAM_PIN_CAP_HDMI(wp->wclass.pin.cap) &&
1958 			    HDA_PARAM_PIN_CAP_HBR(wp->wclass.pin.cap)) {
1959 				wp->wclass.pin.ctrl &=
1960 				    ~HDA_CMD_SET_PIN_WIDGET_CTRL_VREF_ENABLE_MASK;
1961 				if ((ch->fmt & AFMT_AC3) && (cchn == 7))
1962 					wp->wclass.pin.ctrl |= 0x03;
1963 				hda_command(ch->devinfo->dev,
1964 				    HDA_CMD_SET_PIN_WIDGET_CTRL(0, nid,
1965 				    wp->wclass.pin.ctrl));
1966 			}
1967 
1968 			/* Stop audio infoframe transmission. */
1969 			hda_command(ch->devinfo->dev,
1970 			    HDA_CMD_SET_HDMI_DIP_INDEX(0, nid, 0x00));
1971 			hda_command(ch->devinfo->dev,
1972 			    HDA_CMD_SET_HDMI_DIP_XMIT(0, nid, 0x00));
1973 
1974 			/* Clear audio infoframe buffer. */
1975 			hda_command(ch->devinfo->dev,
1976 			    HDA_CMD_SET_HDMI_DIP_INDEX(0, nid, 0x00));
1977 			for (k = 0; k < 32; k++)
1978 				hda_command(ch->devinfo->dev,
1979 				    HDA_CMD_SET_HDMI_DIP_DATA(0, nid, 0x00));
1980 
1981 			/* Write HDMI/DisplayPort audio infoframe. */
1982 			hda_command(ch->devinfo->dev,
1983 			    HDA_CMD_SET_HDMI_DIP_INDEX(0, nid, 0x00));
1984 			if (w->eld != NULL && w->eld_len >= 6 &&
1985 			    ((w->eld[5] >> 2) & 0x3) == 1) { /* DisplayPort */
1986 				hda_command(ch->devinfo->dev,
1987 				    HDA_CMD_SET_HDMI_DIP_DATA(0, nid, 0x84));
1988 				hda_command(ch->devinfo->dev,
1989 				    HDA_CMD_SET_HDMI_DIP_DATA(0, nid, 0x1b));
1990 				hda_command(ch->devinfo->dev,
1991 				    HDA_CMD_SET_HDMI_DIP_DATA(0, nid, 0x44));
1992 			} else {	/* HDMI */
1993 				hda_command(ch->devinfo->dev,
1994 				    HDA_CMD_SET_HDMI_DIP_DATA(0, nid, 0x84));
1995 				hda_command(ch->devinfo->dev,
1996 				    HDA_CMD_SET_HDMI_DIP_DATA(0, nid, 0x01));
1997 				hda_command(ch->devinfo->dev,
1998 				    HDA_CMD_SET_HDMI_DIP_DATA(0, nid, 0x0a));
1999 				csum = 0;
2000 				csum -= 0x84 + 0x01 + 0x0a + (totalchn - 1) +
2001 				    hdmica[totalextchn == 0 ? 0 : 1][totalchn - 1];
2002 				hda_command(ch->devinfo->dev,
2003 				    HDA_CMD_SET_HDMI_DIP_DATA(0, nid, csum));
2004 			}
2005 			hda_command(ch->devinfo->dev,
2006 			    HDA_CMD_SET_HDMI_DIP_DATA(0, nid, totalchn - 1));
2007 			hda_command(ch->devinfo->dev,
2008 			    HDA_CMD_SET_HDMI_DIP_DATA(0, nid, 0x00));
2009 			hda_command(ch->devinfo->dev,
2010 			    HDA_CMD_SET_HDMI_DIP_DATA(0, nid, 0x00));
2011 			hda_command(ch->devinfo->dev,
2012 			    HDA_CMD_SET_HDMI_DIP_DATA(0, nid,
2013 			    hdmica[totalextchn == 0 ? 0 : 1][totalchn - 1]));
2014 
2015 			/* Start audio infoframe transmission. */
2016 			hda_command(ch->devinfo->dev,
2017 			    HDA_CMD_SET_HDMI_DIP_INDEX(0, nid, 0x00));
2018 			hda_command(ch->devinfo->dev,
2019 			    HDA_CMD_SET_HDMI_DIP_XMIT(0, nid, 0xc0));
2020 		}
2021 		chn += cchn + 1;
2022 	}
2023 }
2024 
2025 /*
2026  * Greatest Common Divisor.
2027  */
2028 static unsigned
gcd(unsigned a,unsigned b)2029 gcd(unsigned a, unsigned b)
2030 {
2031 	u_int c;
2032 
2033 	while (b != 0) {
2034 		c = a;
2035 		a = b;
2036 		b = (c % b);
2037 	}
2038 	return (a);
2039 }
2040 
2041 /*
2042  * Least Common Multiple.
2043  */
2044 static unsigned
lcm(unsigned a,unsigned b)2045 lcm(unsigned a, unsigned b)
2046 {
2047 
2048 	return ((a * b) / gcd(a, b));
2049 }
2050 
2051 static int
hdaa_channel_setfragments(kobj_t obj,void * data,uint32_t blksz,uint32_t blkcnt)2052 hdaa_channel_setfragments(kobj_t obj, void *data,
2053 					uint32_t blksz, uint32_t blkcnt)
2054 {
2055 	struct hdaa_chan *ch = data;
2056 
2057 	blksz -= blksz % lcm(HDA_DMA_ALIGNMENT, sndbuf_getalign(ch->b));
2058 
2059 	if (blksz > (sndbuf_getmaxsize(ch->b) / HDA_BDL_MIN))
2060 		blksz = sndbuf_getmaxsize(ch->b) / HDA_BDL_MIN;
2061 	if (blksz < HDA_BLK_MIN)
2062 		blksz = HDA_BLK_MIN;
2063 	if (blkcnt > HDA_BDL_MAX)
2064 		blkcnt = HDA_BDL_MAX;
2065 	if (blkcnt < HDA_BDL_MIN)
2066 		blkcnt = HDA_BDL_MIN;
2067 
2068 	while ((blksz * blkcnt) > sndbuf_getmaxsize(ch->b)) {
2069 		if ((blkcnt >> 1) >= HDA_BDL_MIN)
2070 			blkcnt >>= 1;
2071 		else if ((blksz >> 1) >= HDA_BLK_MIN)
2072 			blksz >>= 1;
2073 		else
2074 			break;
2075 	}
2076 
2077 	if ((sndbuf_getblksz(ch->b) != blksz ||
2078 	    sndbuf_getblkcnt(ch->b) != blkcnt) &&
2079 	    sndbuf_resize(ch->b, blkcnt, blksz) != 0)
2080 		device_printf(ch->devinfo->dev, "%s: failed blksz=%u blkcnt=%u\n",
2081 		    __func__, blksz, blkcnt);
2082 
2083 	ch->blksz = sndbuf_getblksz(ch->b);
2084 	ch->blkcnt = sndbuf_getblkcnt(ch->b);
2085 
2086 	return (0);
2087 }
2088 
2089 static uint32_t
hdaa_channel_setblocksize(kobj_t obj,void * data,uint32_t blksz)2090 hdaa_channel_setblocksize(kobj_t obj, void *data, uint32_t blksz)
2091 {
2092 	struct hdaa_chan *ch = data;
2093 
2094 	hdaa_channel_setfragments(obj, data, blksz, ch->pdevinfo->chan_blkcnt);
2095 
2096 	return (ch->blksz);
2097 }
2098 
2099 static void
hdaa_channel_stop(struct hdaa_chan * ch)2100 hdaa_channel_stop(struct hdaa_chan *ch)
2101 {
2102 	struct hdaa_devinfo *devinfo = ch->devinfo;
2103 	struct hdaa_widget *w;
2104 	int i;
2105 
2106 	if ((ch->flags & HDAA_CHN_RUNNING) == 0)
2107 		return;
2108 	ch->flags &= ~HDAA_CHN_RUNNING;
2109 	HDAC_STREAM_STOP(device_get_parent(devinfo->dev), devinfo->dev,
2110 	    ch->dir == PCMDIR_PLAY ? 1 : 0, ch->sid);
2111 	for (i = 0; ch->io[i] != -1; i++) {
2112 		w = hdaa_widget_get(ch->devinfo, ch->io[i]);
2113 		if (w == NULL)
2114 			continue;
2115 		if (HDA_PARAM_AUDIO_WIDGET_CAP_DIGITAL(w->param.widget_cap)) {
2116 			hda_command(devinfo->dev,
2117 			    HDA_CMD_SET_DIGITAL_CONV_FMT1(0, ch->io[i], 0));
2118 		}
2119 		hda_command(devinfo->dev,
2120 		    HDA_CMD_SET_CONV_STREAM_CHAN(0, ch->io[i],
2121 		    0));
2122 	}
2123 	HDAC_STREAM_FREE(device_get_parent(devinfo->dev), devinfo->dev,
2124 	    ch->dir == PCMDIR_PLAY ? 1 : 0, ch->sid);
2125 }
2126 
2127 static int
hdaa_channel_start(struct hdaa_chan * ch)2128 hdaa_channel_start(struct hdaa_chan *ch)
2129 {
2130 	struct hdaa_devinfo *devinfo = ch->devinfo;
2131 	uint32_t fmt;
2132 
2133 	fmt = hdaa_stream_format(ch);
2134 	ch->stripectl = fls(ch->stripecap & hdaa_allowed_stripes(fmt) &
2135 	    hda_get_stripes_mask(devinfo->dev)) - 1;
2136 	ch->sid = HDAC_STREAM_ALLOC(device_get_parent(devinfo->dev), devinfo->dev,
2137 	    ch->dir == PCMDIR_PLAY ? 1 : 0, fmt, ch->stripectl, &ch->dmapos);
2138 	if (ch->sid <= 0)
2139 		return (EBUSY);
2140 	hdaa_audio_setup(ch);
2141 	HDAC_STREAM_RESET(device_get_parent(devinfo->dev), devinfo->dev,
2142 	    ch->dir == PCMDIR_PLAY ? 1 : 0, ch->sid);
2143 	HDAC_STREAM_START(device_get_parent(devinfo->dev), devinfo->dev,
2144 	    ch->dir == PCMDIR_PLAY ? 1 : 0, ch->sid,
2145 	    sndbuf_getbufaddr(ch->b), ch->blksz, ch->blkcnt);
2146 	ch->flags |= HDAA_CHN_RUNNING;
2147 	return (0);
2148 }
2149 
2150 static int
hdaa_channel_trigger(kobj_t obj,void * data,int go)2151 hdaa_channel_trigger(kobj_t obj, void *data, int go)
2152 {
2153 	struct hdaa_chan *ch = data;
2154 	int error = 0;
2155 
2156 	if (!PCMTRIG_COMMON(go))
2157 		return (0);
2158 
2159 	hdaa_lock(ch->devinfo);
2160 	switch (go) {
2161 	case PCMTRIG_START:
2162 		error = hdaa_channel_start(ch);
2163 		break;
2164 	case PCMTRIG_STOP:
2165 	case PCMTRIG_ABORT:
2166 		hdaa_channel_stop(ch);
2167 		break;
2168 	default:
2169 		break;
2170 	}
2171 	hdaa_unlock(ch->devinfo);
2172 
2173 	return (error);
2174 }
2175 
2176 static uint32_t
hdaa_channel_getptr(kobj_t obj,void * data)2177 hdaa_channel_getptr(kobj_t obj, void *data)
2178 {
2179 	struct hdaa_chan *ch = data;
2180 	struct hdaa_devinfo *devinfo = ch->devinfo;
2181 	uint32_t ptr;
2182 
2183 	hdaa_lock(devinfo);
2184 	if (ch->dmapos != NULL) {
2185 		ptr = *(ch->dmapos);
2186 	} else {
2187 		ptr = HDAC_STREAM_GETPTR(
2188 		    device_get_parent(devinfo->dev), devinfo->dev,
2189 		    ch->dir == PCMDIR_PLAY ? 1 : 0, ch->sid);
2190 	}
2191 	hdaa_unlock(devinfo);
2192 
2193 	/*
2194 	 * Round to available space and force 128 bytes alignment.
2195 	 */
2196 	ptr %= ch->blksz * ch->blkcnt;
2197 	ptr &= HDA_BLK_ALIGN;
2198 
2199 	return (ptr);
2200 }
2201 
2202 static struct pcmchan_caps *
hdaa_channel_getcaps(kobj_t obj,void * data)2203 hdaa_channel_getcaps(kobj_t obj, void *data)
2204 {
2205 	return (&((struct hdaa_chan *)data)->caps);
2206 }
2207 
2208 static kobj_method_t hdaa_channel_methods[] = {
2209 	KOBJMETHOD(channel_init,		hdaa_channel_init),
2210 	KOBJMETHOD(channel_setformat,		hdaa_channel_setformat),
2211 	KOBJMETHOD(channel_setspeed,		hdaa_channel_setspeed),
2212 	KOBJMETHOD(channel_setblocksize,	hdaa_channel_setblocksize),
2213 	KOBJMETHOD(channel_setfragments,	hdaa_channel_setfragments),
2214 	KOBJMETHOD(channel_trigger,		hdaa_channel_trigger),
2215 	KOBJMETHOD(channel_getptr,		hdaa_channel_getptr),
2216 	KOBJMETHOD(channel_getcaps,		hdaa_channel_getcaps),
2217 	KOBJMETHOD_END
2218 };
2219 CHANNEL_DECLARE(hdaa_channel);
2220 
2221 static int
hdaa_audio_ctl_ossmixer_init(struct snd_mixer * m)2222 hdaa_audio_ctl_ossmixer_init(struct snd_mixer *m)
2223 {
2224 	struct hdaa_pcm_devinfo *pdevinfo = mix_getdevinfo(m);
2225 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
2226 	struct hdaa_widget *w, *cw;
2227 	uint32_t mask, recmask;
2228 	int i, j;
2229 
2230 	hdaa_lock(devinfo);
2231 	pdevinfo->mixer = m;
2232 
2233 	/* Make sure that in case of soft volume it won't stay muted. */
2234 	for (i = 0; i < SOUND_MIXER_NRDEVICES; i++) {
2235 		pdevinfo->left[i] = 100;
2236 		pdevinfo->right[i] = 100;
2237 	}
2238 
2239 	/* Declare volume controls assigned to this association. */
2240 	mask = pdevinfo->ossmask;
2241 	if (pdevinfo->playas >= 0) {
2242 		/* Declate EAPD as ogain control. */
2243 		for (i = devinfo->startnode; i < devinfo->endnode; i++) {
2244 			w = hdaa_widget_get(devinfo, i);
2245 			if (w == NULL || w->enable == 0)
2246 				continue;
2247 			if (w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX ||
2248 			    w->param.eapdbtl == HDA_INVALID ||
2249 			    w->bindas != pdevinfo->playas)
2250 				continue;
2251 			mask |= SOUND_MASK_OGAIN;
2252 			break;
2253 		}
2254 
2255 		/* Declare soft PCM volume if needed. */
2256 		if ((mask & SOUND_MASK_PCM) == 0 ||
2257 		    (devinfo->quirks & HDAA_QUIRK_SOFTPCMVOL) ||
2258 		    pdevinfo->minamp[SOUND_MIXER_PCM] ==
2259 		     pdevinfo->maxamp[SOUND_MIXER_PCM]) {
2260 			mask |= SOUND_MASK_PCM;
2261 			pcm_setflags(pdevinfo->dev, pcm_getflags(pdevinfo->dev) | SD_F_SOFTPCMVOL);
2262 			HDA_BOOTHVERBOSE(
2263 				device_printf(pdevinfo->dev,
2264 				    "Forcing Soft PCM volume\n");
2265 			);
2266 		}
2267 
2268 		/* Declare master volume if needed. */
2269 		if ((mask & SOUND_MASK_VOLUME) == 0) {
2270 			mask |= SOUND_MASK_VOLUME;
2271 			mix_setparentchild(m, SOUND_MIXER_VOLUME,
2272 			    SOUND_MASK_PCM);
2273 			mix_setrealdev(m, SOUND_MIXER_VOLUME,
2274 			    SOUND_MIXER_NONE);
2275 			HDA_BOOTHVERBOSE(
2276 				device_printf(pdevinfo->dev,
2277 				    "Forcing master volume with PCM\n");
2278 			);
2279 		}
2280 	}
2281 
2282 	/* Declare record sources available to this association. */
2283 	recmask = 0;
2284 	if (pdevinfo->recas >= 0) {
2285 		for (i = 0; i < 16; i++) {
2286 			if (devinfo->as[pdevinfo->recas].dacs[0][i] < 0)
2287 				continue;
2288 			w = hdaa_widget_get(devinfo,
2289 			    devinfo->as[pdevinfo->recas].dacs[0][i]);
2290 			if (w == NULL || w->enable == 0)
2291 				continue;
2292 			for (j = 0; j < w->nconns; j++) {
2293 				if (w->connsenable[j] == 0)
2294 					continue;
2295 				cw = hdaa_widget_get(devinfo, w->conns[j]);
2296 				if (cw == NULL || cw->enable == 0)
2297 					continue;
2298 				if (cw->bindas != pdevinfo->recas &&
2299 				    cw->bindas != -2)
2300 					continue;
2301 				recmask |= cw->ossmask;
2302 			}
2303 		}
2304 	}
2305 
2306 	recmask &= (1 << SOUND_MIXER_NRDEVICES) - 1;
2307 	mask &= (1 << SOUND_MIXER_NRDEVICES) - 1;
2308 	pdevinfo->ossmask = mask;
2309 
2310 	mix_setrecdevs(m, recmask);
2311 	mix_setdevs(m, mask);
2312 
2313 	hdaa_unlock(devinfo);
2314 
2315 	return (0);
2316 }
2317 
2318 /*
2319  * Update amplification per pdevinfo per ossdev, calculate summary coefficient
2320  * and write it to codec, update *left and *right to reflect remaining error.
2321  */
2322 static void
hdaa_audio_ctl_dev_set(struct hdaa_audio_ctl * ctl,int ossdev,int mute,int * left,int * right)2323 hdaa_audio_ctl_dev_set(struct hdaa_audio_ctl *ctl, int ossdev,
2324     int mute, int *left, int *right)
2325 {
2326 	int i, zleft, zright, sleft, sright, smute, lval, rval;
2327 
2328 	ctl->devleft[ossdev] = *left;
2329 	ctl->devright[ossdev] = *right;
2330 	ctl->devmute[ossdev] = mute;
2331 	smute = sleft = sright = zleft = zright = 0;
2332 	for (i = 0; i < SOUND_MIXER_NRDEVICES; i++) {
2333 		sleft += ctl->devleft[i];
2334 		sright += ctl->devright[i];
2335 		smute |= ctl->devmute[i];
2336 		if (i == ossdev)
2337 			continue;
2338 		zleft += ctl->devleft[i];
2339 		zright += ctl->devright[i];
2340 	}
2341 	lval = QDB2VAL(ctl, sleft);
2342 	rval = QDB2VAL(ctl, sright);
2343 	hdaa_audio_ctl_amp_set(ctl, smute, lval, rval);
2344 	*left -= VAL2QDB(ctl, lval) - VAL2QDB(ctl, QDB2VAL(ctl, zleft));
2345 	*right -= VAL2QDB(ctl, rval) - VAL2QDB(ctl, QDB2VAL(ctl, zright));
2346 }
2347 
2348 /*
2349  * Trace signal from source, setting volumes on the way.
2350  */
2351 static void
hdaa_audio_ctl_source_volume(struct hdaa_pcm_devinfo * pdevinfo,int ossdev,nid_t nid,int index,int mute,int left,int right,int depth)2352 hdaa_audio_ctl_source_volume(struct hdaa_pcm_devinfo *pdevinfo,
2353     int ossdev, nid_t nid, int index, int mute, int left, int right, int depth)
2354 {
2355 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
2356 	struct hdaa_widget *w, *wc;
2357 	struct hdaa_audio_ctl *ctl;
2358 	int i, j, conns = 0;
2359 
2360 	if (depth > HDA_PARSE_MAXDEPTH)
2361 		return;
2362 
2363 	w = hdaa_widget_get(devinfo, nid);
2364 	if (w == NULL || w->enable == 0)
2365 		return;
2366 
2367 	/* Count number of active inputs. */
2368 	if (depth > 0) {
2369 		for (j = 0; j < w->nconns; j++) {
2370 			if (!w->connsenable[j])
2371 				continue;
2372 			conns++;
2373 		}
2374 	}
2375 
2376 	/* If this is not a first step - use input mixer.
2377 	   Pins have common input ctl so care must be taken. */
2378 	if (depth > 0 && (conns == 1 ||
2379 	    w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)) {
2380 		ctl = hdaa_audio_ctl_amp_get(devinfo, w->nid, HDAA_CTL_IN,
2381 		    index, 1);
2382 		if (ctl)
2383 			hdaa_audio_ctl_dev_set(ctl, ossdev, mute, &left, &right);
2384 	}
2385 
2386 	/* If widget has own ossdev - not traverse it.
2387 	   It will be traversed on its own. */
2388 	if (w->ossdev >= 0 && depth > 0)
2389 		return;
2390 
2391 	/* We must not traverse pin */
2392 	if ((w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_INPUT ||
2393 	    w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX) &&
2394 	    depth > 0)
2395 		return;
2396 
2397 	/*
2398 	 * If signals mixed, we can't assign controls farther.
2399 	 * Ignore this on depth zero. Caller must knows why.
2400 	 */
2401 	if (conns > 1 &&
2402 	    (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_MIXER ||
2403 	     w->selconn != index))
2404 		return;
2405 
2406 	ctl = hdaa_audio_ctl_amp_get(devinfo, w->nid, HDAA_CTL_OUT, -1, 1);
2407 	if (ctl)
2408 		hdaa_audio_ctl_dev_set(ctl, ossdev, mute, &left, &right);
2409 
2410 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
2411 		wc = hdaa_widget_get(devinfo, i);
2412 		if (wc == NULL || wc->enable == 0)
2413 			continue;
2414 		for (j = 0; j < wc->nconns; j++) {
2415 			if (wc->connsenable[j] && wc->conns[j] == nid) {
2416 				hdaa_audio_ctl_source_volume(pdevinfo, ossdev,
2417 				    wc->nid, j, mute, left, right, depth + 1);
2418 			}
2419 		}
2420 	}
2421 	return;
2422 }
2423 
2424 /*
2425  * Trace signal from destination, setting volumes on the way.
2426  */
2427 static void
hdaa_audio_ctl_dest_volume(struct hdaa_pcm_devinfo * pdevinfo,int ossdev,nid_t nid,int index,int mute,int left,int right,int depth)2428 hdaa_audio_ctl_dest_volume(struct hdaa_pcm_devinfo *pdevinfo,
2429     int ossdev, nid_t nid, int index, int mute, int left, int right, int depth)
2430 {
2431 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
2432 	struct hdaa_audio_as *as = devinfo->as;
2433 	struct hdaa_widget *w, *wc;
2434 	struct hdaa_audio_ctl *ctl;
2435 	int i, j, consumers, cleft, cright;
2436 
2437 	if (depth > HDA_PARSE_MAXDEPTH)
2438 		return;
2439 
2440 	w = hdaa_widget_get(devinfo, nid);
2441 	if (w == NULL || w->enable == 0)
2442 		return;
2443 
2444 	if (depth > 0) {
2445 		/* If this node produce output for several consumers,
2446 		   we can't touch it. */
2447 		consumers = 0;
2448 		for (i = devinfo->startnode; i < devinfo->endnode; i++) {
2449 			wc = hdaa_widget_get(devinfo, i);
2450 			if (wc == NULL || wc->enable == 0)
2451 				continue;
2452 			for (j = 0; j < wc->nconns; j++) {
2453 				if (wc->connsenable[j] && wc->conns[j] == nid)
2454 					consumers++;
2455 			}
2456 		}
2457 		/* The only exception is if real HP redirection is configured
2458 		   and this is a duplication point.
2459 		   XXX: Actually exception is not completely correct.
2460 		   XXX: Duplication point check is not perfect. */
2461 		if ((consumers == 2 && (w->bindas < 0 ||
2462 		    as[w->bindas].hpredir < 0 || as[w->bindas].fakeredir ||
2463 		    (w->bindseqmask & (1 << 15)) == 0)) ||
2464 		    consumers > 2)
2465 			return;
2466 
2467 		/* Else use it's output mixer. */
2468 		ctl = hdaa_audio_ctl_amp_get(devinfo, w->nid,
2469 		    HDAA_CTL_OUT, -1, 1);
2470 		if (ctl)
2471 			hdaa_audio_ctl_dev_set(ctl, ossdev, mute, &left, &right);
2472 	}
2473 
2474 	/* We must not traverse pin */
2475 	if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX &&
2476 	    depth > 0)
2477 		return;
2478 
2479 	for (i = 0; i < w->nconns; i++) {
2480 		if (w->connsenable[i] == 0)
2481 			continue;
2482 		if (index >= 0 && i != index)
2483 			continue;
2484 		cleft = left;
2485 		cright = right;
2486 		ctl = hdaa_audio_ctl_amp_get(devinfo, w->nid,
2487 		    HDAA_CTL_IN, i, 1);
2488 		if (ctl)
2489 			hdaa_audio_ctl_dev_set(ctl, ossdev, mute, &cleft, &cright);
2490 		hdaa_audio_ctl_dest_volume(pdevinfo, ossdev, w->conns[i], -1,
2491 		    mute, cleft, cright, depth + 1);
2492 	}
2493 }
2494 
2495 /*
2496  * Set volumes for the specified pdevinfo and ossdev.
2497  */
2498 static void
hdaa_audio_ctl_dev_volume(struct hdaa_pcm_devinfo * pdevinfo,unsigned dev)2499 hdaa_audio_ctl_dev_volume(struct hdaa_pcm_devinfo *pdevinfo, unsigned dev)
2500 {
2501 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
2502 	struct hdaa_widget *w, *cw;
2503 	uint32_t mute;
2504 	int lvol, rvol;
2505 	int i, j;
2506 
2507 	mute = 0;
2508 	if (pdevinfo->left[dev] == 0) {
2509 		mute |= HDAA_AMP_MUTE_LEFT;
2510 		lvol = -4000;
2511 	} else
2512 		lvol = ((pdevinfo->maxamp[dev] - pdevinfo->minamp[dev]) *
2513 		    pdevinfo->left[dev] + 50) / 100 + pdevinfo->minamp[dev];
2514 	if (pdevinfo->right[dev] == 0) {
2515 		mute |= HDAA_AMP_MUTE_RIGHT;
2516 		rvol = -4000;
2517 	} else
2518 		rvol = ((pdevinfo->maxamp[dev] - pdevinfo->minamp[dev]) *
2519 		    pdevinfo->right[dev] + 50) / 100 + pdevinfo->minamp[dev];
2520 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
2521 		w = hdaa_widget_get(devinfo, i);
2522 		if (w == NULL || w->enable == 0)
2523 			continue;
2524 		if (w->bindas < 0) {
2525 			if (pdevinfo->index != 0)
2526 				continue;
2527 		} else {
2528 			if (w->bindas != pdevinfo->playas &&
2529 			    w->bindas != pdevinfo->recas)
2530 				continue;
2531 		}
2532 		if (dev == SOUND_MIXER_RECLEV &&
2533 		    w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_INPUT) {
2534 			hdaa_audio_ctl_dest_volume(pdevinfo, dev,
2535 			    w->nid, -1, mute, lvol, rvol, 0);
2536 			continue;
2537 		}
2538 		if (dev == SOUND_MIXER_VOLUME &&
2539 		    w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX &&
2540 		    devinfo->as[w->bindas].dir == HDAA_CTL_OUT) {
2541 			hdaa_audio_ctl_dest_volume(pdevinfo, dev,
2542 			    w->nid, -1, mute, lvol, rvol, 0);
2543 			continue;
2544 		}
2545 		if (dev == SOUND_MIXER_IGAIN &&
2546 		    w->pflags & HDAA_ADC_MONITOR) {
2547 			for (j = 0; j < w->nconns; j++) {
2548 				if (!w->connsenable[j])
2549 				    continue;
2550 				cw = hdaa_widget_get(devinfo, w->conns[j]);
2551 				if (cw == NULL || cw->enable == 0)
2552 				    continue;
2553 				if (cw->bindas == -1)
2554 				    continue;
2555 				if (cw->bindas >= 0 &&
2556 				    devinfo->as[cw->bindas].dir != HDAA_CTL_IN)
2557 					continue;
2558 				hdaa_audio_ctl_dest_volume(pdevinfo, dev,
2559 				    w->nid, j, mute, lvol, rvol, 0);
2560 			}
2561 			continue;
2562 		}
2563 		if (w->ossdev != dev)
2564 			continue;
2565 		hdaa_audio_ctl_source_volume(pdevinfo, dev,
2566 		    w->nid, -1, mute, lvol, rvol, 0);
2567 		if (dev == SOUND_MIXER_IMIX && (w->pflags & HDAA_IMIX_AS_DST))
2568 			hdaa_audio_ctl_dest_volume(pdevinfo, dev,
2569 			    w->nid, -1, mute, lvol, rvol, 0);
2570 	}
2571 }
2572 
2573 /*
2574  * OSS Mixer set method.
2575  */
2576 static int
hdaa_audio_ctl_ossmixer_set(struct snd_mixer * m,unsigned dev,unsigned left,unsigned right)2577 hdaa_audio_ctl_ossmixer_set(struct snd_mixer *m, unsigned dev,
2578 					unsigned left, unsigned right)
2579 {
2580 	struct hdaa_pcm_devinfo *pdevinfo = mix_getdevinfo(m);
2581 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
2582 	struct hdaa_widget *w;
2583 	int i;
2584 
2585 	hdaa_lock(devinfo);
2586 
2587 	/* Save new values. */
2588 	pdevinfo->left[dev] = left;
2589 	pdevinfo->right[dev] = right;
2590 
2591 	/* 'ogain' is the special case implemented with EAPD. */
2592 	if (dev == SOUND_MIXER_OGAIN) {
2593 		uint32_t orig;
2594 		w = NULL;
2595 		for (i = devinfo->startnode; i < devinfo->endnode; i++) {
2596 			w = hdaa_widget_get(devinfo, i);
2597 			if (w == NULL || w->enable == 0)
2598 				continue;
2599 			if (w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX ||
2600 			    w->param.eapdbtl == HDA_INVALID)
2601 				continue;
2602 			break;
2603 		}
2604 		if (i >= devinfo->endnode) {
2605 			hdaa_unlock(devinfo);
2606 			return (-1);
2607 		}
2608 		orig = w->param.eapdbtl;
2609 		if (left == 0)
2610 			w->param.eapdbtl &= ~HDA_CMD_SET_EAPD_BTL_ENABLE_EAPD;
2611 		else
2612 			w->param.eapdbtl |= HDA_CMD_SET_EAPD_BTL_ENABLE_EAPD;
2613 		if (orig != w->param.eapdbtl) {
2614 			uint32_t val;
2615 
2616 			val = w->param.eapdbtl;
2617 			if (devinfo->quirks & HDAA_QUIRK_EAPDINV)
2618 				val ^= HDA_CMD_SET_EAPD_BTL_ENABLE_EAPD;
2619 			hda_command(devinfo->dev,
2620 			    HDA_CMD_SET_EAPD_BTL_ENABLE(0, w->nid, val));
2621 		}
2622 		hdaa_unlock(devinfo);
2623 		return (left | (left << 8));
2624 	}
2625 
2626 	/* Recalculate all controls related to this OSS device. */
2627 	hdaa_audio_ctl_dev_volume(pdevinfo, dev);
2628 
2629 	hdaa_unlock(devinfo);
2630 	return (left | (right << 8));
2631 }
2632 
2633 /*
2634  * Set mixer settings to our own default values:
2635  * +20dB for mics, -10dB for analog vol, mute for igain, 0dB for others.
2636  */
2637 static void
hdaa_audio_ctl_set_defaults(struct hdaa_pcm_devinfo * pdevinfo)2638 hdaa_audio_ctl_set_defaults(struct hdaa_pcm_devinfo *pdevinfo)
2639 {
2640 	int amp, vol, dev;
2641 
2642 	for (dev = 0; dev < SOUND_MIXER_NRDEVICES; dev++) {
2643 		if ((pdevinfo->ossmask & (1 << dev)) == 0)
2644 			continue;
2645 
2646 		/* If the value was overridden, leave it as is. */
2647 		if (resource_int_value(device_get_name(pdevinfo->dev),
2648 		    device_get_unit(pdevinfo->dev), ossnames[dev], &vol) == 0)
2649 			continue;
2650 
2651 		vol = -1;
2652 		if (dev == SOUND_MIXER_OGAIN)
2653 			vol = 100;
2654 		else if (dev == SOUND_MIXER_IGAIN)
2655 			vol = 0;
2656 		else if (dev == SOUND_MIXER_MIC ||
2657 		    dev == SOUND_MIXER_MONITOR)
2658 			amp = 20 * 4;	/* +20dB */
2659 		else if (dev == SOUND_MIXER_VOLUME && !pdevinfo->digital)
2660 			amp = -10 * 4;	/* -10dB */
2661 		else
2662 			amp = 0;
2663 		if (vol < 0 &&
2664 		    (pdevinfo->maxamp[dev] - pdevinfo->minamp[dev]) <= 0) {
2665 			vol = 100;
2666 		} else if (vol < 0) {
2667 			vol = ((amp - pdevinfo->minamp[dev]) * 100 +
2668 			    (pdevinfo->maxamp[dev] - pdevinfo->minamp[dev]) / 2) /
2669 			    (pdevinfo->maxamp[dev] - pdevinfo->minamp[dev]);
2670 			vol = imin(imax(vol, 1), 100);
2671 		}
2672 		mix_set(pdevinfo->mixer, dev, vol, vol);
2673 	}
2674 }
2675 
2676 /*
2677  * Recursively commutate specified record source.
2678  */
2679 static uint32_t
hdaa_audio_ctl_recsel_comm(struct hdaa_pcm_devinfo * pdevinfo,uint32_t src,nid_t nid,int depth)2680 hdaa_audio_ctl_recsel_comm(struct hdaa_pcm_devinfo *pdevinfo, uint32_t src, nid_t nid, int depth)
2681 {
2682 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
2683 	struct hdaa_widget *w, *cw;
2684 	struct hdaa_audio_ctl *ctl;
2685 	char buf[64];
2686 	int i, muted;
2687 	uint32_t res = 0;
2688 
2689 	if (depth > HDA_PARSE_MAXDEPTH)
2690 		return (0);
2691 
2692 	w = hdaa_widget_get(devinfo, nid);
2693 	if (w == NULL || w->enable == 0)
2694 		return (0);
2695 
2696 	for (i = 0; i < w->nconns; i++) {
2697 		if (w->connsenable[i] == 0)
2698 			continue;
2699 		cw = hdaa_widget_get(devinfo, w->conns[i]);
2700 		if (cw == NULL || cw->enable == 0 || cw->bindas == -1)
2701 			continue;
2702 		/* Call recursively to trace signal to it's source if needed. */
2703 		if ((src & cw->ossmask) != 0) {
2704 			if (cw->ossdev < 0) {
2705 				res |= hdaa_audio_ctl_recsel_comm(pdevinfo, src,
2706 				    w->conns[i], depth + 1);
2707 			} else {
2708 				res |= cw->ossmask;
2709 			}
2710 		}
2711 		/* We have two special cases: mixers and others (selectors). */
2712 		if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_MIXER) {
2713 			ctl = hdaa_audio_ctl_amp_get(devinfo,
2714 			    w->nid, HDAA_CTL_IN, i, 1);
2715 			if (ctl == NULL)
2716 				continue;
2717 			/* If we have input control on this node mute them
2718 			 * according to requested sources. */
2719 			muted = (src & cw->ossmask) ? 0 : 1;
2720 			if (muted != ctl->forcemute) {
2721 				ctl->forcemute = muted;
2722 				hdaa_audio_ctl_amp_set(ctl,
2723 				    HDAA_AMP_MUTE_DEFAULT,
2724 				    HDAA_AMP_VOL_DEFAULT, HDAA_AMP_VOL_DEFAULT);
2725 			}
2726 			HDA_BOOTHVERBOSE(
2727 				device_printf(pdevinfo->dev,
2728 				    "Recsel (%s): nid %d source %d %s\n",
2729 				    hdaa_audio_ctl_ossmixer_mask2allname(
2730 				    src, buf, sizeof(buf)),
2731 				    nid, i, muted?"mute":"unmute");
2732 			);
2733 		} else {
2734 			if (w->nconns == 1)
2735 				break;
2736 			if ((src & cw->ossmask) == 0)
2737 				continue;
2738 			/* If we found requested source - select it and exit. */
2739 			hdaa_widget_connection_select(w, i);
2740 			HDA_BOOTHVERBOSE(
2741 				device_printf(pdevinfo->dev,
2742 				    "Recsel (%s): nid %d source %d select\n",
2743 				    hdaa_audio_ctl_ossmixer_mask2allname(
2744 				    src, buf, sizeof(buf)),
2745 				    nid, i);
2746 			);
2747 			break;
2748 		}
2749 	}
2750 	return (res);
2751 }
2752 
2753 static uint32_t
hdaa_audio_ctl_ossmixer_setrecsrc(struct snd_mixer * m,uint32_t src)2754 hdaa_audio_ctl_ossmixer_setrecsrc(struct snd_mixer *m, uint32_t src)
2755 {
2756 	struct hdaa_pcm_devinfo *pdevinfo = mix_getdevinfo(m);
2757 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
2758 	struct hdaa_widget *w;
2759 	struct hdaa_audio_as *as;
2760 	struct hdaa_audio_ctl *ctl;
2761 	struct hdaa_chan *ch;
2762 	int i, j;
2763 	uint32_t ret = 0xffffffff;
2764 
2765 	hdaa_lock(devinfo);
2766 	if (pdevinfo->recas < 0) {
2767 		hdaa_unlock(devinfo);
2768 		return (0);
2769 	}
2770 	as = &devinfo->as[pdevinfo->recas];
2771 
2772 	/* For non-mixed associations we always recording everything. */
2773 	if (!as->mixed) {
2774 		hdaa_unlock(devinfo);
2775 		return (mix_getrecdevs(m));
2776 	}
2777 
2778 	/* Commutate requested recsrc for each ADC. */
2779 	for (j = 0; j < as->num_chans; j++) {
2780 		ch = &devinfo->chans[as->chans[j]];
2781 		for (i = 0; ch->io[i] >= 0; i++) {
2782 			w = hdaa_widget_get(devinfo, ch->io[i]);
2783 			if (w == NULL || w->enable == 0)
2784 				continue;
2785 			ret &= hdaa_audio_ctl_recsel_comm(pdevinfo, src,
2786 			    ch->io[i], 0);
2787 		}
2788 	}
2789 	if (ret == 0xffffffff)
2790 		ret = 0;
2791 
2792 	/*
2793 	 * Some controls could be shared. Reset volumes for controls
2794 	 * related to previously chosen devices, as they may no longer
2795 	 * affect the signal.
2796 	 */
2797 	i = 0;
2798 	while ((ctl = hdaa_audio_ctl_each(devinfo, &i)) != NULL) {
2799 		if (ctl->enable == 0 ||
2800 		    !(ctl->ossmask & pdevinfo->recsrc))
2801 			continue;
2802 		if (!((pdevinfo->playas >= 0 &&
2803 		    ctl->widget->bindas == pdevinfo->playas) ||
2804 		    (pdevinfo->recas >= 0 &&
2805 		    ctl->widget->bindas == pdevinfo->recas) ||
2806 		    (pdevinfo->index == 0 &&
2807 		    ctl->widget->bindas == -2)))
2808 			continue;
2809 		for (j = 0; j < SOUND_MIXER_NRDEVICES; j++) {
2810 			if (pdevinfo->recsrc & (1 << j)) {
2811 				ctl->devleft[j] = 0;
2812 				ctl->devright[j] = 0;
2813 				ctl->devmute[j] = 0;
2814 			}
2815 		}
2816 	}
2817 
2818 	/*
2819 	 * Some controls could be shared. Set volumes for controls
2820 	 * related to devices selected both previously and now.
2821 	 */
2822 	for (j = 0; j < SOUND_MIXER_NRDEVICES; j++) {
2823 		if ((ret | pdevinfo->recsrc) & (1 << j))
2824 			hdaa_audio_ctl_dev_volume(pdevinfo, j);
2825 	}
2826 
2827 	pdevinfo->recsrc = ret;
2828 	hdaa_unlock(devinfo);
2829 	return (ret);
2830 }
2831 
2832 static kobj_method_t hdaa_audio_ctl_ossmixer_methods[] = {
2833 	KOBJMETHOD(mixer_init,		hdaa_audio_ctl_ossmixer_init),
2834 	KOBJMETHOD(mixer_set,		hdaa_audio_ctl_ossmixer_set),
2835 	KOBJMETHOD(mixer_setrecsrc,	hdaa_audio_ctl_ossmixer_setrecsrc),
2836 	KOBJMETHOD_END
2837 };
2838 MIXER_DECLARE(hdaa_audio_ctl_ossmixer);
2839 
2840 static void
hdaa_dump_gpi(struct hdaa_devinfo * devinfo)2841 hdaa_dump_gpi(struct hdaa_devinfo *devinfo)
2842 {
2843 	device_t dev = devinfo->dev;
2844 	int i;
2845 	uint32_t data, wake, unsol, sticky;
2846 
2847 	if (HDA_PARAM_GPIO_COUNT_NUM_GPI(devinfo->gpio_cap) > 0) {
2848 		data = hda_command(dev,
2849 		    HDA_CMD_GET_GPI_DATA(0, devinfo->nid));
2850 		wake = hda_command(dev,
2851 		    HDA_CMD_GET_GPI_WAKE_ENABLE_MASK(0, devinfo->nid));
2852 		unsol = hda_command(dev,
2853 		    HDA_CMD_GET_GPI_UNSOLICITED_ENABLE_MASK(0, devinfo->nid));
2854 		sticky = hda_command(dev,
2855 		    HDA_CMD_GET_GPI_STICKY_MASK(0, devinfo->nid));
2856 		for (i = 0; i < HDA_PARAM_GPIO_COUNT_NUM_GPI(devinfo->gpio_cap); i++) {
2857 			device_printf(dev, " GPI%d:%s%s%s state=%d", i,
2858 				    (sticky & (1 << i)) ? " sticky" : "",
2859 				    (unsol & (1 << i)) ? " unsol" : "",
2860 				    (wake & (1 << i)) ? " wake" : "",
2861 				    (data >> i) & 1);
2862 		}
2863 	}
2864 }
2865 
2866 static void
hdaa_dump_gpio(struct hdaa_devinfo * devinfo)2867 hdaa_dump_gpio(struct hdaa_devinfo *devinfo)
2868 {
2869 	device_t dev = devinfo->dev;
2870 	int i;
2871 	uint32_t data, dir, enable, wake, unsol, sticky;
2872 
2873 	if (HDA_PARAM_GPIO_COUNT_NUM_GPIO(devinfo->gpio_cap) > 0) {
2874 		data = hda_command(dev,
2875 		    HDA_CMD_GET_GPIO_DATA(0, devinfo->nid));
2876 		enable = hda_command(dev,
2877 		    HDA_CMD_GET_GPIO_ENABLE_MASK(0, devinfo->nid));
2878 		dir = hda_command(dev,
2879 		    HDA_CMD_GET_GPIO_DIRECTION(0, devinfo->nid));
2880 		wake = hda_command(dev,
2881 		    HDA_CMD_GET_GPIO_WAKE_ENABLE_MASK(0, devinfo->nid));
2882 		unsol = hda_command(dev,
2883 		    HDA_CMD_GET_GPIO_UNSOLICITED_ENABLE_MASK(0, devinfo->nid));
2884 		sticky = hda_command(dev,
2885 		    HDA_CMD_GET_GPIO_STICKY_MASK(0, devinfo->nid));
2886 		for (i = 0; i < HDA_PARAM_GPIO_COUNT_NUM_GPIO(devinfo->gpio_cap); i++) {
2887 			device_printf(dev, " GPIO%d: ", i);
2888 			if ((enable & (1 << i)) == 0) {
2889 				printf("disabled\n");
2890 				continue;
2891 			}
2892 			if ((dir & (1 << i)) == 0) {
2893 				printf("input%s%s%s",
2894 				    (sticky & (1 << i)) ? " sticky" : "",
2895 				    (unsol & (1 << i)) ? " unsol" : "",
2896 				    (wake & (1 << i)) ? " wake" : "");
2897 			} else
2898 				printf("output");
2899 			printf(" state=%d\n", (data >> i) & 1);
2900 		}
2901 	}
2902 }
2903 
2904 static void
hdaa_dump_gpo(struct hdaa_devinfo * devinfo)2905 hdaa_dump_gpo(struct hdaa_devinfo *devinfo)
2906 {
2907 	device_t dev = devinfo->dev;
2908 	int i;
2909 	uint32_t data;
2910 
2911 	if (HDA_PARAM_GPIO_COUNT_NUM_GPO(devinfo->gpio_cap) > 0) {
2912 		data = hda_command(dev,
2913 		    HDA_CMD_GET_GPO_DATA(0, devinfo->nid));
2914 		for (i = 0; i < HDA_PARAM_GPIO_COUNT_NUM_GPO(devinfo->gpio_cap); i++) {
2915 			device_printf(dev, " GPO%d: state=%d", i,
2916 				    (data >> i) & 1);
2917 		}
2918 	}
2919 }
2920 
2921 static void
hdaa_audio_parse(struct hdaa_devinfo * devinfo)2922 hdaa_audio_parse(struct hdaa_devinfo *devinfo)
2923 {
2924 	struct hdaa_widget *w;
2925 	uint32_t res;
2926 	int i;
2927 	nid_t nid;
2928 
2929 	nid = devinfo->nid;
2930 
2931 	res = hda_command(devinfo->dev,
2932 	    HDA_CMD_GET_PARAMETER(0, nid, HDA_PARAM_GPIO_COUNT));
2933 	devinfo->gpio_cap = res;
2934 
2935 	HDA_BOOTVERBOSE(
2936 		device_printf(devinfo->dev,
2937 		    "NumGPIO=%d NumGPO=%d "
2938 		    "NumGPI=%d GPIWake=%d GPIUnsol=%d\n",
2939 		    HDA_PARAM_GPIO_COUNT_NUM_GPIO(devinfo->gpio_cap),
2940 		    HDA_PARAM_GPIO_COUNT_NUM_GPO(devinfo->gpio_cap),
2941 		    HDA_PARAM_GPIO_COUNT_NUM_GPI(devinfo->gpio_cap),
2942 		    HDA_PARAM_GPIO_COUNT_GPI_WAKE(devinfo->gpio_cap),
2943 		    HDA_PARAM_GPIO_COUNT_GPI_UNSOL(devinfo->gpio_cap));
2944 		hdaa_dump_gpi(devinfo);
2945 		hdaa_dump_gpio(devinfo);
2946 		hdaa_dump_gpo(devinfo);
2947 	);
2948 
2949 	res = hda_command(devinfo->dev,
2950 	    HDA_CMD_GET_PARAMETER(0, nid, HDA_PARAM_SUPP_STREAM_FORMATS));
2951 	devinfo->supp_stream_formats = res;
2952 
2953 	res = hda_command(devinfo->dev,
2954 	    HDA_CMD_GET_PARAMETER(0, nid, HDA_PARAM_SUPP_PCM_SIZE_RATE));
2955 	devinfo->supp_pcm_size_rate = res;
2956 
2957 	res = hda_command(devinfo->dev,
2958 	    HDA_CMD_GET_PARAMETER(0, nid, HDA_PARAM_OUTPUT_AMP_CAP));
2959 	devinfo->outamp_cap = res;
2960 
2961 	res = hda_command(devinfo->dev,
2962 	    HDA_CMD_GET_PARAMETER(0, nid, HDA_PARAM_INPUT_AMP_CAP));
2963 	devinfo->inamp_cap = res;
2964 
2965 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
2966 		w = hdaa_widget_get(devinfo, i);
2967 		if (w == NULL)
2968 			device_printf(devinfo->dev, "Ghost widget! nid=%d!\n", i);
2969 		else {
2970 			w->devinfo = devinfo;
2971 			w->nid = i;
2972 			w->enable = 1;
2973 			w->selconn = -1;
2974 			w->pflags = 0;
2975 			w->ossdev = -1;
2976 			w->bindas = -1;
2977 			w->param.eapdbtl = HDA_INVALID;
2978 			hdaa_widget_parse(w);
2979 		}
2980 	}
2981 }
2982 
2983 static void
hdaa_audio_postprocess(struct hdaa_devinfo * devinfo)2984 hdaa_audio_postprocess(struct hdaa_devinfo *devinfo)
2985 {
2986 	struct hdaa_widget *w;
2987 	int i;
2988 
2989 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
2990 		w = hdaa_widget_get(devinfo, i);
2991 		if (w == NULL)
2992 			continue;
2993 		hdaa_widget_postprocess(w);
2994 	}
2995 }
2996 
2997 static void
hdaa_audio_ctl_parse(struct hdaa_devinfo * devinfo)2998 hdaa_audio_ctl_parse(struct hdaa_devinfo *devinfo)
2999 {
3000 	struct hdaa_audio_ctl *ctls;
3001 	struct hdaa_widget *w, *cw;
3002 	int i, j, cnt, max, ocap, icap;
3003 	int mute, offset, step, size;
3004 
3005 	/* XXX This is redundant */
3006 	max = 0;
3007 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
3008 		w = hdaa_widget_get(devinfo, i);
3009 		if (w == NULL || w->enable == 0)
3010 			continue;
3011 		if (w->param.outamp_cap != 0)
3012 			max++;
3013 		if (w->param.inamp_cap != 0) {
3014 			switch (w->type) {
3015 			case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_SELECTOR:
3016 			case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_MIXER:
3017 				for (j = 0; j < w->nconns; j++) {
3018 					cw = hdaa_widget_get(devinfo,
3019 					    w->conns[j]);
3020 					if (cw == NULL || cw->enable == 0)
3021 						continue;
3022 					max++;
3023 				}
3024 				break;
3025 			default:
3026 				max++;
3027 				break;
3028 			}
3029 		}
3030 	}
3031 	devinfo->ctlcnt = max;
3032 
3033 	if (max < 1)
3034 		return;
3035 
3036 	ctls = malloc(sizeof(*ctls) * max, M_HDAA, M_ZERO | M_NOWAIT);
3037 
3038 	if (ctls == NULL) {
3039 		/* Blekh! */
3040 		device_printf(devinfo->dev, "unable to allocate ctls!\n");
3041 		devinfo->ctlcnt = 0;
3042 		return;
3043 	}
3044 
3045 	cnt = 0;
3046 	for (i = devinfo->startnode; cnt < max && i < devinfo->endnode; i++) {
3047 		if (cnt >= max) {
3048 			device_printf(devinfo->dev, "%s: Ctl overflow!\n",
3049 			    __func__);
3050 			break;
3051 		}
3052 		w = hdaa_widget_get(devinfo, i);
3053 		if (w == NULL || w->enable == 0)
3054 			continue;
3055 		ocap = w->param.outamp_cap;
3056 		icap = w->param.inamp_cap;
3057 		if (ocap != 0) {
3058 			mute = HDA_PARAM_OUTPUT_AMP_CAP_MUTE_CAP(ocap);
3059 			step = HDA_PARAM_OUTPUT_AMP_CAP_NUMSTEPS(ocap);
3060 			size = HDA_PARAM_OUTPUT_AMP_CAP_STEPSIZE(ocap);
3061 			offset = HDA_PARAM_OUTPUT_AMP_CAP_OFFSET(ocap);
3062 			/*if (offset > step) {
3063 				HDA_BOOTVERBOSE(
3064 					device_printf(devinfo->dev,
3065 					    "BUGGY outamp: nid=%d "
3066 					    "[offset=%d > step=%d]\n",
3067 					    w->nid, offset, step);
3068 				);
3069 				offset = step;
3070 			}*/
3071 			ctls[cnt].enable = 1;
3072 			ctls[cnt].widget = w;
3073 			ctls[cnt].mute = mute;
3074 			ctls[cnt].step = step;
3075 			ctls[cnt].size = size;
3076 			ctls[cnt].offset = offset;
3077 			ctls[cnt].left = offset;
3078 			ctls[cnt].right = offset;
3079 			if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX ||
3080 			    w->waspin)
3081 				ctls[cnt].ndir = HDAA_CTL_IN;
3082 			else
3083 				ctls[cnt].ndir = HDAA_CTL_OUT;
3084 			ctls[cnt++].dir = HDAA_CTL_OUT;
3085 		}
3086 
3087 		if (icap != 0) {
3088 			mute = HDA_PARAM_OUTPUT_AMP_CAP_MUTE_CAP(icap);
3089 			step = HDA_PARAM_OUTPUT_AMP_CAP_NUMSTEPS(icap);
3090 			size = HDA_PARAM_OUTPUT_AMP_CAP_STEPSIZE(icap);
3091 			offset = HDA_PARAM_OUTPUT_AMP_CAP_OFFSET(icap);
3092 			/*if (offset > step) {
3093 				HDA_BOOTVERBOSE(
3094 					device_printf(devinfo->dev,
3095 					    "BUGGY inamp: nid=%d "
3096 					    "[offset=%d > step=%d]\n",
3097 					    w->nid, offset, step);
3098 				);
3099 				offset = step;
3100 			}*/
3101 			switch (w->type) {
3102 			case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_SELECTOR:
3103 			case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_MIXER:
3104 				for (j = 0; j < w->nconns; j++) {
3105 					if (cnt >= max) {
3106 						device_printf(devinfo->dev,
3107 						    "%s: Ctl overflow!\n",
3108 						    __func__);
3109 						break;
3110 					}
3111 					cw = hdaa_widget_get(devinfo,
3112 					    w->conns[j]);
3113 					if (cw == NULL || cw->enable == 0)
3114 						continue;
3115 					ctls[cnt].enable = 1;
3116 					ctls[cnt].widget = w;
3117 					ctls[cnt].childwidget = cw;
3118 					ctls[cnt].index = j;
3119 					ctls[cnt].mute = mute;
3120 					ctls[cnt].step = step;
3121 					ctls[cnt].size = size;
3122 					ctls[cnt].offset = offset;
3123 					ctls[cnt].left = offset;
3124 					ctls[cnt].right = offset;
3125 				ctls[cnt].ndir = HDAA_CTL_IN;
3126 					ctls[cnt++].dir = HDAA_CTL_IN;
3127 				}
3128 				break;
3129 			default:
3130 				if (cnt >= max) {
3131 					device_printf(devinfo->dev,
3132 					    "%s: Ctl overflow!\n",
3133 					    __func__);
3134 					break;
3135 				}
3136 				ctls[cnt].enable = 1;
3137 				ctls[cnt].widget = w;
3138 				ctls[cnt].mute = mute;
3139 				ctls[cnt].step = step;
3140 				ctls[cnt].size = size;
3141 				ctls[cnt].offset = offset;
3142 				ctls[cnt].left = offset;
3143 				ctls[cnt].right = offset;
3144 				if (w->type ==
3145 				    HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
3146 					ctls[cnt].ndir = HDAA_CTL_OUT;
3147 				else
3148 					ctls[cnt].ndir = HDAA_CTL_IN;
3149 				ctls[cnt++].dir = HDAA_CTL_IN;
3150 				break;
3151 			}
3152 		}
3153 	}
3154 
3155 	devinfo->ctl = ctls;
3156 }
3157 
3158 static void
hdaa_audio_as_parse(struct hdaa_devinfo * devinfo)3159 hdaa_audio_as_parse(struct hdaa_devinfo *devinfo)
3160 {
3161 	struct hdaa_audio_as *as;
3162 	struct hdaa_widget *w;
3163 	int i, j, cnt, max, type, dir, assoc, seq, first, hpredir;
3164 
3165 	/* Count present associations */
3166 	max = 0;
3167 	for (j = 1; j < 16; j++) {
3168 		for (i = devinfo->startnode; i < devinfo->endnode; i++) {
3169 			w = hdaa_widget_get(devinfo, i);
3170 			if (w == NULL || w->enable == 0)
3171 				continue;
3172 			if (w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
3173 				continue;
3174 			if (HDA_CONFIG_DEFAULTCONF_ASSOCIATION(w->wclass.pin.config)
3175 			    != j)
3176 				continue;
3177 			max++;
3178 			if (j != 15)  /* There could be many 1-pin assocs #15 */
3179 				break;
3180 		}
3181 	}
3182 
3183 	devinfo->ascnt = max;
3184 
3185 	if (max < 1)
3186 		return;
3187 
3188 	as = malloc(sizeof(*as) * max, M_HDAA, M_ZERO | M_NOWAIT);
3189 
3190 	if (as == NULL) {
3191 		/* Blekh! */
3192 		device_printf(devinfo->dev, "unable to allocate assocs!\n");
3193 		devinfo->ascnt = 0;
3194 		return;
3195 	}
3196 
3197 	for (i = 0; i < max; i++) {
3198 		as[i].hpredir = -1;
3199 		as[i].digital = 0;
3200 		as[i].num_chans = 1;
3201 		as[i].location = -1;
3202 	}
3203 
3204 	/* Scan associations skipping as=0. */
3205 	cnt = 0;
3206 	for (j = 1; j < 16 && cnt < max; j++) {
3207 		first = 16;
3208 		hpredir = 0;
3209 		for (i = devinfo->startnode; i < devinfo->endnode; i++) {
3210 			w = hdaa_widget_get(devinfo, i);
3211 			if (w == NULL || w->enable == 0)
3212 				continue;
3213 			if (w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
3214 				continue;
3215 			assoc = HDA_CONFIG_DEFAULTCONF_ASSOCIATION(w->wclass.pin.config);
3216 			seq = HDA_CONFIG_DEFAULTCONF_SEQUENCE(w->wclass.pin.config);
3217 			if (assoc != j) {
3218 				continue;
3219 			}
3220 			KASSERT(cnt < max,
3221 			    ("%s: Associations owerflow (%d of %d)",
3222 			    __func__, cnt, max));
3223 			type = w->wclass.pin.config &
3224 			    HDA_CONFIG_DEFAULTCONF_DEVICE_MASK;
3225 			/* Get pin direction. */
3226 			if (type == HDA_CONFIG_DEFAULTCONF_DEVICE_LINE_OUT ||
3227 			    type == HDA_CONFIG_DEFAULTCONF_DEVICE_SPEAKER ||
3228 			    type == HDA_CONFIG_DEFAULTCONF_DEVICE_HP_OUT ||
3229 			    type == HDA_CONFIG_DEFAULTCONF_DEVICE_SPDIF_OUT ||
3230 			    type == HDA_CONFIG_DEFAULTCONF_DEVICE_DIGITAL_OTHER_OUT)
3231 				dir = HDAA_CTL_OUT;
3232 			else
3233 				dir = HDAA_CTL_IN;
3234 			/* If this is a first pin - create new association. */
3235 			if (as[cnt].pincnt == 0) {
3236 				as[cnt].enable = 1;
3237 				as[cnt].index = j;
3238 				as[cnt].dir = dir;
3239 			}
3240 			if (seq < first)
3241 				first = seq;
3242 			/* Check association correctness. */
3243 			if (as[cnt].pins[seq] != 0) {
3244 				device_printf(devinfo->dev, "%s: Duplicate pin %d (%d) "
3245 				    "in association %d! Disabling association.\n",
3246 				    __func__, seq, w->nid, j);
3247 				as[cnt].enable = 0;
3248 			}
3249 			if (dir != as[cnt].dir) {
3250 				device_printf(devinfo->dev, "%s: Pin %d has wrong "
3251 				    "direction for association %d! Disabling "
3252 				    "association.\n",
3253 				    __func__, w->nid, j);
3254 				as[cnt].enable = 0;
3255 			}
3256 			if (HDA_PARAM_AUDIO_WIDGET_CAP_DIGITAL(w->param.widget_cap)) {
3257 				as[cnt].digital |= 0x1;
3258 				if (HDA_PARAM_PIN_CAP_HDMI(w->wclass.pin.cap))
3259 					as[cnt].digital |= 0x2;
3260 				if (HDA_PARAM_PIN_CAP_DP(w->wclass.pin.cap))
3261 					as[cnt].digital |= 0x4;
3262 			}
3263 			if (as[cnt].location == -1) {
3264 				as[cnt].location =
3265 				    HDA_CONFIG_DEFAULTCONF_LOCATION(w->wclass.pin.config);
3266 			} else if (as[cnt].location !=
3267 			    HDA_CONFIG_DEFAULTCONF_LOCATION(w->wclass.pin.config)) {
3268 				as[cnt].location = -2;
3269 			}
3270 			/* Headphones with seq=15 may mean redirection. */
3271 			if (type == HDA_CONFIG_DEFAULTCONF_DEVICE_HP_OUT &&
3272 			    seq == 15)
3273 				hpredir = 1;
3274 			as[cnt].pins[seq] = w->nid;
3275 			as[cnt].pincnt++;
3276 			/* Association 15 is a multiple unassociated pins. */
3277 			if (j == 15)
3278 				cnt++;
3279 		}
3280 		if (j != 15 && as[cnt].pincnt > 0) {
3281 			if (hpredir && as[cnt].pincnt > 1)
3282 				as[cnt].hpredir = first;
3283 			cnt++;
3284 		}
3285 	}
3286 	for (i = 0; i < max; i++) {
3287 		if (as[i].dir == HDAA_CTL_IN && (as[i].pincnt == 1 ||
3288 		    as[i].pins[14] > 0 || as[i].pins[15] > 0))
3289 			as[i].mixed = 1;
3290 	}
3291 	HDA_BOOTVERBOSE(
3292 		device_printf(devinfo->dev,
3293 		    "%d associations found:\n", max);
3294 		for (i = 0; i < max; i++) {
3295 			device_printf(devinfo->dev,
3296 			    "Association %d (%d) %s%s:\n",
3297 			    i, as[i].index, (as[i].dir == HDAA_CTL_IN)?"in":"out",
3298 			    as[i].enable?"":" (disabled)");
3299 			for (j = 0; j < 16; j++) {
3300 				if (as[i].pins[j] == 0)
3301 					continue;
3302 				device_printf(devinfo->dev,
3303 				    " Pin nid=%d seq=%d\n",
3304 				    as[i].pins[j], j);
3305 			}
3306 		}
3307 	);
3308 
3309 	devinfo->as = as;
3310 }
3311 
3312 /*
3313  * Trace path from DAC to pin.
3314  */
3315 static nid_t
hdaa_audio_trace_dac(struct hdaa_devinfo * devinfo,int as,int seq,nid_t nid,int dupseq,int min,int only,int depth)3316 hdaa_audio_trace_dac(struct hdaa_devinfo *devinfo, int as, int seq, nid_t nid,
3317     int dupseq, int min, int only, int depth)
3318 {
3319 	struct hdaa_widget *w;
3320 	int i, im = -1;
3321 	nid_t m = 0, ret;
3322 
3323 	if (depth > HDA_PARSE_MAXDEPTH)
3324 		return (0);
3325 	w = hdaa_widget_get(devinfo, nid);
3326 	if (w == NULL || w->enable == 0)
3327 		return (0);
3328 	HDA_BOOTHVERBOSE(
3329 		if (!only) {
3330 			device_printf(devinfo->dev,
3331 			    " %*stracing via nid %d\n",
3332 				depth + 1, "", w->nid);
3333 		}
3334 	);
3335 	/* Use only unused widgets */
3336 	if (w->bindas >= 0 && w->bindas != as) {
3337 		HDA_BOOTHVERBOSE(
3338 			if (!only) {
3339 				device_printf(devinfo->dev,
3340 				    " %*snid %d busy by association %d\n",
3341 					depth + 1, "", w->nid, w->bindas);
3342 			}
3343 		);
3344 		return (0);
3345 	}
3346 	if (dupseq < 0) {
3347 		if (w->bindseqmask != 0) {
3348 			HDA_BOOTHVERBOSE(
3349 				if (!only) {
3350 					device_printf(devinfo->dev,
3351 					    " %*snid %d busy by seqmask %x\n",
3352 						depth + 1, "", w->nid, w->bindseqmask);
3353 				}
3354 			);
3355 			return (0);
3356 		}
3357 	} else {
3358 		/* If this is headphones - allow duplicate first pin. */
3359 		if (w->bindseqmask != 0 &&
3360 		    (w->bindseqmask & (1 << dupseq)) == 0) {
3361 			HDA_BOOTHVERBOSE(
3362 				device_printf(devinfo->dev,
3363 				    " %*snid %d busy by seqmask %x\n",
3364 					depth + 1, "", w->nid, w->bindseqmask);
3365 			);
3366 			return (0);
3367 		}
3368 	}
3369 
3370 	switch (w->type) {
3371 	case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_INPUT:
3372 		/* Do not traverse input. AD1988 has digital monitor
3373 		for which we are not ready. */
3374 		break;
3375 	case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_OUTPUT:
3376 		/* If we are tracing HP take only dac of first pin. */
3377 		if ((only == 0 || only == w->nid) &&
3378 		    (w->nid >= min) && (dupseq < 0 || w->nid ==
3379 		    devinfo->as[as].dacs[0][dupseq]))
3380 			m = w->nid;
3381 		break;
3382 	case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX:
3383 		if (depth > 0)
3384 			break;
3385 		/* Fall */
3386 	default:
3387 		/* Find reachable DACs with smallest nid respecting constraints. */
3388 		for (i = 0; i < w->nconns; i++) {
3389 			if (w->connsenable[i] == 0)
3390 				continue;
3391 			if (w->selconn != -1 && w->selconn != i)
3392 				continue;
3393 			if ((ret = hdaa_audio_trace_dac(devinfo, as, seq,
3394 			    w->conns[i], dupseq, min, only, depth + 1)) != 0) {
3395 				if (m == 0 || ret < m) {
3396 					m = ret;
3397 					im = i;
3398 				}
3399 				if (only || dupseq >= 0)
3400 					break;
3401 			}
3402 		}
3403 		if (im >= 0 && only && ((w->nconns > 1 &&
3404 		    w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_MIXER) ||
3405 		    w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_SELECTOR))
3406 			w->selconn = im;
3407 		break;
3408 	}
3409 	if (m && only) {
3410 		w->bindas = as;
3411 		w->bindseqmask |= (1 << seq);
3412 	}
3413 	HDA_BOOTHVERBOSE(
3414 		if (!only) {
3415 			device_printf(devinfo->dev,
3416 			    " %*snid %d returned %d\n",
3417 				depth + 1, "", w->nid, m);
3418 		}
3419 	);
3420 	return (m);
3421 }
3422 
3423 /*
3424  * Trace path from widget to ADC.
3425  */
3426 static nid_t
hdaa_audio_trace_adc(struct hdaa_devinfo * devinfo,int as,int seq,nid_t nid,int mixed,int min,int only,int depth,int * length,int onlylength)3427 hdaa_audio_trace_adc(struct hdaa_devinfo *devinfo, int as, int seq, nid_t nid,
3428     int mixed, int min, int only, int depth, int *length, int onlylength)
3429 {
3430 	struct hdaa_widget *w, *wc;
3431 	int i, j, im, lm = HDA_PARSE_MAXDEPTH;
3432 	nid_t m = 0, ret;
3433 
3434 	if (depth > HDA_PARSE_MAXDEPTH)
3435 		return (0);
3436 	w = hdaa_widget_get(devinfo, nid);
3437 	if (w == NULL || w->enable == 0)
3438 		return (0);
3439 	HDA_BOOTHVERBOSE(
3440 		device_printf(devinfo->dev,
3441 		    " %*stracing via nid %d\n",
3442 			depth + 1, "", w->nid);
3443 	);
3444 	/* Use only unused widgets */
3445 	if (w->bindas >= 0 && w->bindas != as) {
3446 		HDA_BOOTHVERBOSE(
3447 			device_printf(devinfo->dev,
3448 			    " %*snid %d busy by association %d\n",
3449 				depth + 1, "", w->nid, w->bindas);
3450 		);
3451 		return (0);
3452 	}
3453 	if (!mixed && w->bindseqmask != 0) {
3454 		HDA_BOOTHVERBOSE(
3455 			device_printf(devinfo->dev,
3456 			    " %*snid %d busy by seqmask %x\n",
3457 				depth + 1, "", w->nid, w->bindseqmask);
3458 		);
3459 		return (0);
3460 	}
3461 	switch (w->type) {
3462 	case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_INPUT:
3463 		if ((only == 0 || only == w->nid) && (w->nid >= min) &&
3464 		    (onlylength == 0 || onlylength == depth)) {
3465 			m = w->nid;
3466 			*length = depth;
3467 		}
3468 		break;
3469 	case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX:
3470 		if (depth > 0)
3471 			break;
3472 		/* Fall */
3473 	default:
3474 		/* Try to find reachable ADCs with specified nid. */
3475 		for (j = devinfo->startnode; j < devinfo->endnode; j++) {
3476 			wc = hdaa_widget_get(devinfo, j);
3477 			if (wc == NULL || wc->enable == 0)
3478 				continue;
3479 			im = -1;
3480 			for (i = 0; i < wc->nconns; i++) {
3481 				if (wc->connsenable[i] == 0)
3482 					continue;
3483 				if (wc->conns[i] != nid)
3484 					continue;
3485 				if ((ret = hdaa_audio_trace_adc(devinfo, as, seq,
3486 				    j, mixed, min, only, depth + 1,
3487 				    length, onlylength)) != 0) {
3488 					if (m == 0 || ret < m ||
3489 					    (ret == m && *length < lm)) {
3490 						m = ret;
3491 						im = i;
3492 						lm = *length;
3493 					} else
3494 						*length = lm;
3495 					if (only)
3496 						break;
3497 				}
3498 			}
3499 			if (im >= 0 && only && ((wc->nconns > 1 &&
3500 			    wc->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_MIXER) ||
3501 			    wc->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_SELECTOR))
3502 				wc->selconn = im;
3503 		}
3504 		break;
3505 	}
3506 	if (m && only) {
3507 		w->bindas = as;
3508 		w->bindseqmask |= (1 << seq);
3509 	}
3510 	HDA_BOOTHVERBOSE(
3511 		device_printf(devinfo->dev,
3512 		    " %*snid %d returned %d\n",
3513 			depth + 1, "", w->nid, m);
3514 	);
3515 	return (m);
3516 }
3517 
3518 /*
3519  * Erase trace path of the specified association.
3520  */
3521 static void
hdaa_audio_undo_trace(struct hdaa_devinfo * devinfo,int as,int seq)3522 hdaa_audio_undo_trace(struct hdaa_devinfo *devinfo, int as, int seq)
3523 {
3524 	struct hdaa_widget *w;
3525 	int i;
3526 
3527 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
3528 		w = hdaa_widget_get(devinfo, i);
3529 		if (w == NULL || w->enable == 0)
3530 			continue;
3531 		if (w->bindas == as) {
3532 			if (seq >= 0) {
3533 				w->bindseqmask &= ~(1 << seq);
3534 				if (w->bindseqmask == 0) {
3535 					w->bindas = -1;
3536 					w->selconn = -1;
3537 				}
3538 			} else {
3539 				w->bindas = -1;
3540 				w->bindseqmask = 0;
3541 				w->selconn = -1;
3542 			}
3543 		}
3544 	}
3545 }
3546 
3547 /*
3548  * Trace association path from DAC to output
3549  */
3550 static int
hdaa_audio_trace_as_out(struct hdaa_devinfo * devinfo,int as,int seq)3551 hdaa_audio_trace_as_out(struct hdaa_devinfo *devinfo, int as, int seq)
3552 {
3553 	struct hdaa_audio_as *ases = devinfo->as;
3554 	int i, hpredir;
3555 	nid_t min, res;
3556 
3557 	/* Find next pin */
3558 	for (i = seq; i < 16 && ases[as].pins[i] == 0; i++)
3559 		;
3560 	/* Check if there is no any left. If so - we succeeded. */
3561 	if (i == 16)
3562 		return (1);
3563 
3564 	hpredir = (i == 15 && ases[as].fakeredir == 0)?ases[as].hpredir:-1;
3565 	min = 0;
3566 	do {
3567 		HDA_BOOTHVERBOSE(
3568 			device_printf(devinfo->dev,
3569 			    " Tracing pin %d with min nid %d",
3570 			    ases[as].pins[i], min);
3571 			if (hpredir >= 0)
3572 				printf(" and hpredir %d", hpredir);
3573 			printf("\n");
3574 		);
3575 		/* Trace this pin taking min nid into account. */
3576 		res = hdaa_audio_trace_dac(devinfo, as, i,
3577 		    ases[as].pins[i], hpredir, min, 0, 0);
3578 		if (res == 0) {
3579 			/* If we failed - return to previous and redo it. */
3580 			HDA_BOOTVERBOSE(
3581 				device_printf(devinfo->dev,
3582 				    " Unable to trace pin %d seq %d with min "
3583 				    "nid %d",
3584 				    ases[as].pins[i], i, min);
3585 				if (hpredir >= 0)
3586 					printf(" and hpredir %d", hpredir);
3587 				printf("\n");
3588 			);
3589 			return (0);
3590 		}
3591 		HDA_BOOTVERBOSE(
3592 			device_printf(devinfo->dev,
3593 			    " Pin %d traced to DAC %d",
3594 			    ases[as].pins[i], res);
3595 			if (hpredir >= 0)
3596 				printf(" and hpredir %d", hpredir);
3597 			if (ases[as].fakeredir)
3598 				printf(" with fake redirection");
3599 			printf("\n");
3600 		);
3601 		/* Trace again to mark the path */
3602 		hdaa_audio_trace_dac(devinfo, as, i,
3603 		    ases[as].pins[i], hpredir, min, res, 0);
3604 		ases[as].dacs[0][i] = res;
3605 		/* We succeeded, so call next. */
3606 		if (hdaa_audio_trace_as_out(devinfo, as, i + 1))
3607 			return (1);
3608 		/* If next failed, we should retry with next min */
3609 		hdaa_audio_undo_trace(devinfo, as, i);
3610 		ases[as].dacs[0][i] = 0;
3611 		min = res + 1;
3612 	} while (1);
3613 }
3614 
3615 /*
3616  * Check equivalency of two DACs.
3617  */
3618 static int
hdaa_audio_dacs_equal(struct hdaa_widget * w1,struct hdaa_widget * w2)3619 hdaa_audio_dacs_equal(struct hdaa_widget *w1, struct hdaa_widget *w2)
3620 {
3621 	struct hdaa_devinfo *devinfo = w1->devinfo;
3622 	struct hdaa_widget *w3;
3623 	int i, j, c1, c2;
3624 
3625 	if (memcmp(&w1->param, &w2->param, sizeof(w1->param)))
3626 		return (0);
3627 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
3628 		w3 = hdaa_widget_get(devinfo, i);
3629 		if (w3 == NULL || w3->enable == 0)
3630 			continue;
3631 		if (w3->bindas != w1->bindas)
3632 			continue;
3633 		if (w3->nconns == 0)
3634 			continue;
3635 		c1 = c2 = -1;
3636 		for (j = 0; j < w3->nconns; j++) {
3637 			if (w3->connsenable[j] == 0)
3638 				continue;
3639 			if (w3->conns[j] == w1->nid)
3640 				c1 = j;
3641 			if (w3->conns[j] == w2->nid)
3642 				c2 = j;
3643 		}
3644 		if (c1 < 0)
3645 			continue;
3646 		if (c2 < 0)
3647 			return (0);
3648 		if (w3->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_MIXER)
3649 			return (0);
3650 	}
3651 	return (1);
3652 }
3653 
3654 /*
3655  * Check equivalency of two ADCs.
3656  */
3657 static int
hdaa_audio_adcs_equal(struct hdaa_widget * w1,struct hdaa_widget * w2)3658 hdaa_audio_adcs_equal(struct hdaa_widget *w1, struct hdaa_widget *w2)
3659 {
3660 	struct hdaa_devinfo *devinfo = w1->devinfo;
3661 	struct hdaa_widget *w3, *w4;
3662 	int i;
3663 
3664 	if (memcmp(&w1->param, &w2->param, sizeof(w1->param)))
3665 		return (0);
3666 	if (w1->nconns != 1 || w2->nconns != 1)
3667 		return (0);
3668 	if (w1->conns[0] == w2->conns[0])
3669 		return (1);
3670 	w3 = hdaa_widget_get(devinfo, w1->conns[0]);
3671 	if (w3 == NULL || w3->enable == 0)
3672 		return (0);
3673 	w4 = hdaa_widget_get(devinfo, w2->conns[0]);
3674 	if (w4 == NULL || w4->enable == 0)
3675 		return (0);
3676 	if (w3->bindas == w4->bindas && w3->bindseqmask == w4->bindseqmask)
3677 		return (1);
3678 	if (w4->bindas >= 0)
3679 		return (0);
3680 	if (w3->type != w4->type)
3681 		return (0);
3682 	if (memcmp(&w3->param, &w4->param, sizeof(w3->param)))
3683 		return (0);
3684 	if (w3->nconns != w4->nconns)
3685 		return (0);
3686 	for (i = 0; i < w3->nconns; i++) {
3687 		if (w3->conns[i] != w4->conns[i])
3688 			return (0);
3689 	}
3690 	return (1);
3691 }
3692 
3693 /*
3694  * Look for equivalent DAC/ADC to implement second channel.
3695  */
3696 static void
hdaa_audio_adddac(struct hdaa_devinfo * devinfo,int asid)3697 hdaa_audio_adddac(struct hdaa_devinfo *devinfo, int asid)
3698 {
3699 	struct hdaa_audio_as *as = &devinfo->as[asid];
3700 	struct hdaa_widget *w1, *w2;
3701 	int i, pos;
3702 	nid_t nid1, nid2;
3703 
3704 	HDA_BOOTVERBOSE(
3705 		device_printf(devinfo->dev,
3706 		    "Looking for additional %sC "
3707 		    "for association %d (%d)\n",
3708 		    (as->dir == HDAA_CTL_OUT) ? "DA" : "AD",
3709 		    asid, as->index);
3710 	);
3711 
3712 	/* Find the existing DAC position and return if found more the one. */
3713 	pos = -1;
3714 	for (i = 0; i < 16; i++) {
3715 		if (as->dacs[0][i] <= 0)
3716 			continue;
3717 		if (pos >= 0 && as->dacs[0][i] != as->dacs[0][pos])
3718 			return;
3719 		pos = i;
3720 	}
3721 
3722 	nid1 = as->dacs[0][pos];
3723 	w1 = hdaa_widget_get(devinfo, nid1);
3724 	w2 = NULL;
3725 	for (nid2 = devinfo->startnode; nid2 < devinfo->endnode; nid2++) {
3726 		w2 = hdaa_widget_get(devinfo, nid2);
3727 		if (w2 == NULL || w2->enable == 0)
3728 			continue;
3729 		if (w2->bindas >= 0)
3730 			continue;
3731 		if (w1->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_OUTPUT) {
3732 			if (w2->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_OUTPUT)
3733 				continue;
3734 			if (hdaa_audio_dacs_equal(w1, w2))
3735 				break;
3736 		} else {
3737 			if (w2->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_INPUT)
3738 				continue;
3739 			if (hdaa_audio_adcs_equal(w1, w2))
3740 				break;
3741 		}
3742 	}
3743 	if (nid2 >= devinfo->endnode)
3744 		return;
3745 	w2->bindas = w1->bindas;
3746 	w2->bindseqmask = w1->bindseqmask;
3747 	if (w1->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_INPUT) {
3748 		HDA_BOOTVERBOSE(
3749 			device_printf(devinfo->dev,
3750 			    " ADC %d considered equal to ADC %d\n", nid2, nid1);
3751 		);
3752 		w1 = hdaa_widget_get(devinfo, w1->conns[0]);
3753 		w2 = hdaa_widget_get(devinfo, w2->conns[0]);
3754 		w2->bindas = w1->bindas;
3755 		w2->bindseqmask = w1->bindseqmask;
3756 	} else {
3757 		HDA_BOOTVERBOSE(
3758 			device_printf(devinfo->dev,
3759 			    " DAC %d considered equal to DAC %d\n", nid2, nid1);
3760 		);
3761 	}
3762 	for (i = 0; i < 16; i++) {
3763 		if (as->dacs[0][i] <= 0)
3764 			continue;
3765 		as->dacs[as->num_chans][i] = nid2;
3766 	}
3767 	as->num_chans++;
3768 }
3769 
3770 /*
3771  * Trace association path from input to ADC
3772  */
3773 static int
hdaa_audio_trace_as_in(struct hdaa_devinfo * devinfo,int as)3774 hdaa_audio_trace_as_in(struct hdaa_devinfo *devinfo, int as)
3775 {
3776 	struct hdaa_audio_as *ases = devinfo->as;
3777 	struct hdaa_widget *w;
3778 	int i, j, k, length;
3779 
3780 	for (j = devinfo->startnode; j < devinfo->endnode; j++) {
3781 		w = hdaa_widget_get(devinfo, j);
3782 		if (w == NULL || w->enable == 0)
3783 			continue;
3784 		if (w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_INPUT)
3785 			continue;
3786 		if (w->bindas >= 0 && w->bindas != as)
3787 			continue;
3788 
3789 		/* Find next pin */
3790 		for (i = 0; i < 16; i++) {
3791 			if (ases[as].pins[i] == 0)
3792 				continue;
3793 
3794 			HDA_BOOTHVERBOSE(
3795 				device_printf(devinfo->dev,
3796 				    " Tracing pin %d to ADC %d\n",
3797 				    ases[as].pins[i], j);
3798 			);
3799 			/* Trace this pin taking goal into account. */
3800 			if (hdaa_audio_trace_adc(devinfo, as, i,
3801 			    ases[as].pins[i], 1, 0, j, 0, &length, 0) == 0) {
3802 				/* If we failed - return to previous and redo it. */
3803 				HDA_BOOTVERBOSE(
3804 					device_printf(devinfo->dev,
3805 					    " Unable to trace pin %d to ADC %d, undo traces\n",
3806 					    ases[as].pins[i], j);
3807 				);
3808 				hdaa_audio_undo_trace(devinfo, as, -1);
3809 				for (k = 0; k < 16; k++)
3810 					ases[as].dacs[0][k] = 0;
3811 				break;
3812 			}
3813 			HDA_BOOTVERBOSE(
3814 				device_printf(devinfo->dev,
3815 				    " Pin %d traced to ADC %d\n",
3816 				    ases[as].pins[i], j);
3817 			);
3818 			ases[as].dacs[0][i] = j;
3819 		}
3820 		if (i == 16)
3821 			return (1);
3822 	}
3823 	return (0);
3824 }
3825 
3826 /*
3827  * Trace association path from input to multiple ADCs
3828  */
3829 static int
hdaa_audio_trace_as_in_mch(struct hdaa_devinfo * devinfo,int as,int seq)3830 hdaa_audio_trace_as_in_mch(struct hdaa_devinfo *devinfo, int as, int seq)
3831 {
3832 	struct hdaa_audio_as *ases = devinfo->as;
3833 	int i, length;
3834 	nid_t min, res;
3835 
3836 	/* Find next pin */
3837 	for (i = seq; i < 16 && ases[as].pins[i] == 0; i++)
3838 		;
3839 	/* Check if there is no any left. If so - we succeeded. */
3840 	if (i == 16)
3841 		return (1);
3842 
3843 	min = 0;
3844 	do {
3845 		HDA_BOOTHVERBOSE(
3846 			device_printf(devinfo->dev,
3847 			    " Tracing pin %d with min nid %d",
3848 			    ases[as].pins[i], min);
3849 			printf("\n");
3850 		);
3851 		/* Trace this pin taking min nid into account. */
3852 		res = hdaa_audio_trace_adc(devinfo, as, i,
3853 		    ases[as].pins[i], 0, min, 0, 0, &length, 0);
3854 		if (res == 0) {
3855 			/* If we failed - return to previous and redo it. */
3856 			HDA_BOOTVERBOSE(
3857 				device_printf(devinfo->dev,
3858 				    " Unable to trace pin %d seq %d with min "
3859 				    "nid %d",
3860 				    ases[as].pins[i], i, min);
3861 				printf("\n");
3862 			);
3863 			return (0);
3864 		}
3865 		HDA_BOOTVERBOSE(
3866 			device_printf(devinfo->dev,
3867 			    " Pin %d traced to ADC %d\n",
3868 			    ases[as].pins[i], res);
3869 		);
3870 		/* Trace again to mark the path */
3871 		hdaa_audio_trace_adc(devinfo, as, i,
3872 		    ases[as].pins[i], 0, min, res, 0, &length, length);
3873 		ases[as].dacs[0][i] = res;
3874 		/* We succeeded, so call next. */
3875 		if (hdaa_audio_trace_as_in_mch(devinfo, as, i + 1))
3876 			return (1);
3877 		/* If next failed, we should retry with next min */
3878 		hdaa_audio_undo_trace(devinfo, as, i);
3879 		ases[as].dacs[0][i] = 0;
3880 		min = res + 1;
3881 	} while (1);
3882 }
3883 
3884 /*
3885  * Trace input monitor path from mixer to output association.
3886  */
3887 static int
hdaa_audio_trace_to_out(struct hdaa_devinfo * devinfo,nid_t nid,int depth)3888 hdaa_audio_trace_to_out(struct hdaa_devinfo *devinfo, nid_t nid, int depth)
3889 {
3890 	struct hdaa_audio_as *ases = devinfo->as;
3891 	struct hdaa_widget *w, *wc;
3892 	int i, j;
3893 	nid_t res = 0;
3894 
3895 	if (depth > HDA_PARSE_MAXDEPTH)
3896 		return (0);
3897 	w = hdaa_widget_get(devinfo, nid);
3898 	if (w == NULL || w->enable == 0)
3899 		return (0);
3900 	HDA_BOOTHVERBOSE(
3901 		device_printf(devinfo->dev,
3902 		    " %*stracing via nid %d\n",
3903 			depth + 1, "", w->nid);
3904 	);
3905 	/* Use only unused widgets */
3906 	if (depth > 0 && w->bindas != -1) {
3907 		if (w->bindas < 0 || ases[w->bindas].dir == HDAA_CTL_OUT) {
3908 			HDA_BOOTHVERBOSE(
3909 				device_printf(devinfo->dev,
3910 				    " %*snid %d found output association %d\n",
3911 					depth + 1, "", w->nid, w->bindas);
3912 			);
3913 			if (w->bindas >= 0)
3914 				w->pflags |= HDAA_ADC_MONITOR;
3915 			return (1);
3916 		} else {
3917 			HDA_BOOTHVERBOSE(
3918 				device_printf(devinfo->dev,
3919 				    " %*snid %d busy by input association %d\n",
3920 					depth + 1, "", w->nid, w->bindas);
3921 			);
3922 			return (0);
3923 		}
3924 	}
3925 
3926 	switch (w->type) {
3927 	case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_INPUT:
3928 		/* Do not traverse input. AD1988 has digital monitor
3929 		for which we are not ready. */
3930 		break;
3931 	case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX:
3932 		if (depth > 0)
3933 			break;
3934 		/* Fall */
3935 	default:
3936 		/* Try to find reachable ADCs with specified nid. */
3937 		for (j = devinfo->startnode; j < devinfo->endnode; j++) {
3938 			wc = hdaa_widget_get(devinfo, j);
3939 			if (wc == NULL || wc->enable == 0)
3940 				continue;
3941 			for (i = 0; i < wc->nconns; i++) {
3942 				if (wc->connsenable[i] == 0)
3943 					continue;
3944 				if (wc->conns[i] != nid)
3945 					continue;
3946 				if (hdaa_audio_trace_to_out(devinfo,
3947 				    j, depth + 1) != 0) {
3948 					res = 1;
3949 					if (wc->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_SELECTOR &&
3950 					    wc->selconn == -1)
3951 						wc->selconn = i;
3952 				}
3953 			}
3954 		}
3955 		break;
3956 	}
3957 	if (res && w->bindas == -1)
3958 		w->bindas = -2;
3959 
3960 	HDA_BOOTHVERBOSE(
3961 		device_printf(devinfo->dev,
3962 		    " %*snid %d returned %d\n",
3963 			depth + 1, "", w->nid, res);
3964 	);
3965 	return (res);
3966 }
3967 
3968 /*
3969  * Trace extra associations (beeper, monitor)
3970  */
3971 static void
hdaa_audio_trace_as_extra(struct hdaa_devinfo * devinfo)3972 hdaa_audio_trace_as_extra(struct hdaa_devinfo *devinfo)
3973 {
3974 	struct hdaa_audio_as *as = devinfo->as;
3975 	struct hdaa_widget *w;
3976 	int j;
3977 
3978 	/* Input monitor */
3979 	/* Find mixer associated with input, but supplying signal
3980 	   for output associations. Hope it will be input monitor. */
3981 	HDA_BOOTVERBOSE(
3982 		device_printf(devinfo->dev,
3983 		    "Tracing input monitor\n");
3984 	);
3985 	for (j = devinfo->startnode; j < devinfo->endnode; j++) {
3986 		w = hdaa_widget_get(devinfo, j);
3987 		if (w == NULL || w->enable == 0)
3988 			continue;
3989 		if (w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_MIXER)
3990 			continue;
3991 		if (w->bindas < 0 || as[w->bindas].dir != HDAA_CTL_IN)
3992 			continue;
3993 		HDA_BOOTVERBOSE(
3994 			device_printf(devinfo->dev,
3995 			    " Tracing nid %d to out\n",
3996 			    j);
3997 		);
3998 		if (hdaa_audio_trace_to_out(devinfo, w->nid, 0)) {
3999 			HDA_BOOTVERBOSE(
4000 				device_printf(devinfo->dev,
4001 				    " nid %d is input monitor\n",
4002 					w->nid);
4003 			);
4004 			w->ossdev = SOUND_MIXER_IMIX;
4005 		}
4006 	}
4007 
4008 	/* Other inputs monitor */
4009 	/* Find input pins supplying signal for output associations.
4010 	   Hope it will be input monitoring. */
4011 	HDA_BOOTVERBOSE(
4012 		device_printf(devinfo->dev,
4013 		    "Tracing other input monitors\n");
4014 	);
4015 	for (j = devinfo->startnode; j < devinfo->endnode; j++) {
4016 		w = hdaa_widget_get(devinfo, j);
4017 		if (w == NULL || w->enable == 0)
4018 			continue;
4019 		if (w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
4020 			continue;
4021 		if (w->bindas < 0 || as[w->bindas].dir != HDAA_CTL_IN)
4022 			continue;
4023 		HDA_BOOTVERBOSE(
4024 			device_printf(devinfo->dev,
4025 			    " Tracing nid %d to out\n",
4026 			    j);
4027 		);
4028 		if (hdaa_audio_trace_to_out(devinfo, w->nid, 0)) {
4029 			HDA_BOOTVERBOSE(
4030 				device_printf(devinfo->dev,
4031 				    " nid %d is input monitor\n",
4032 					w->nid);
4033 			);
4034 		}
4035 	}
4036 
4037 	/* Beeper */
4038 	HDA_BOOTVERBOSE(
4039 		device_printf(devinfo->dev,
4040 		    "Tracing beeper\n");
4041 	);
4042 	for (j = devinfo->startnode; j < devinfo->endnode; j++) {
4043 		w = hdaa_widget_get(devinfo, j);
4044 		if (w == NULL || w->enable == 0)
4045 			continue;
4046 		if (w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_BEEP_WIDGET)
4047 			continue;
4048 		HDA_BOOTHVERBOSE(
4049 			device_printf(devinfo->dev,
4050 			    " Tracing nid %d to out\n",
4051 			    j);
4052 		);
4053 		if (hdaa_audio_trace_to_out(devinfo, w->nid, 0)) {
4054 			HDA_BOOTVERBOSE(
4055 				device_printf(devinfo->dev,
4056 				    " nid %d traced to out\n",
4057 				    j);
4058 			);
4059 		}
4060 		w->bindas = -2;
4061 	}
4062 }
4063 
4064 /*
4065  * Bind assotiations to PCM channels
4066  */
4067 static void
hdaa_audio_bind_as(struct hdaa_devinfo * devinfo)4068 hdaa_audio_bind_as(struct hdaa_devinfo *devinfo)
4069 {
4070 	struct hdaa_audio_as *as = devinfo->as;
4071 	int i, j, cnt = 0, free;
4072 
4073 	for (j = 0; j < devinfo->ascnt; j++) {
4074 		if (as[j].enable)
4075 			cnt += as[j].num_chans;
4076 	}
4077 	if (devinfo->num_chans == 0) {
4078 		devinfo->chans = malloc(sizeof(struct hdaa_chan) * cnt,
4079 		    M_HDAA, M_ZERO | M_NOWAIT);
4080 		if (devinfo->chans == NULL) {
4081 			device_printf(devinfo->dev,
4082 			    "Channels memory allocation failed!\n");
4083 			return;
4084 		}
4085 	} else {
4086 		devinfo->chans = (struct hdaa_chan *)realloc(devinfo->chans,
4087 		    sizeof(struct hdaa_chan) * (devinfo->num_chans + cnt),
4088 		    M_HDAA, M_ZERO | M_NOWAIT);
4089 		if (devinfo->chans == NULL) {
4090 			devinfo->num_chans = 0;
4091 			device_printf(devinfo->dev,
4092 			    "Channels memory allocation failed!\n");
4093 			return;
4094 		}
4095 		/* Fixup relative pointers after realloc */
4096 		for (j = 0; j < devinfo->num_chans; j++)
4097 			devinfo->chans[j].caps.fmtlist = devinfo->chans[j].fmtlist;
4098 	}
4099 	free = devinfo->num_chans;
4100 	devinfo->num_chans += cnt;
4101 
4102 	for (j = free; j < free + cnt; j++) {
4103 		devinfo->chans[j].devinfo = devinfo;
4104 		devinfo->chans[j].as = -1;
4105 	}
4106 
4107 	/* Assign associations in order of their numbers, */
4108 	for (j = 0; j < devinfo->ascnt; j++) {
4109 		if (as[j].enable == 0)
4110 			continue;
4111 		for (i = 0; i < as[j].num_chans; i++) {
4112 			devinfo->chans[free].as = j;
4113 			devinfo->chans[free].asindex = i;
4114 			devinfo->chans[free].dir =
4115 			    (as[j].dir == HDAA_CTL_IN) ? PCMDIR_REC : PCMDIR_PLAY;
4116 			hdaa_pcmchannel_setup(&devinfo->chans[free]);
4117 			as[j].chans[i] = free;
4118 			free++;
4119 		}
4120 	}
4121 }
4122 
4123 static void
hdaa_audio_disable_nonaudio(struct hdaa_devinfo * devinfo)4124 hdaa_audio_disable_nonaudio(struct hdaa_devinfo *devinfo)
4125 {
4126 	struct hdaa_widget *w;
4127 	int i;
4128 
4129 	/* Disable power and volume widgets. */
4130 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
4131 		w = hdaa_widget_get(devinfo, i);
4132 		if (w == NULL || w->enable == 0)
4133 			continue;
4134 		if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_POWER_WIDGET ||
4135 		    w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_VOLUME_WIDGET) {
4136 			w->enable = 0;
4137 			HDA_BOOTHVERBOSE(
4138 				device_printf(devinfo->dev,
4139 				    " Disabling nid %d due to it's"
4140 				    " non-audio type.\n",
4141 				    w->nid);
4142 			);
4143 		}
4144 	}
4145 }
4146 
4147 static void
hdaa_audio_disable_useless(struct hdaa_devinfo * devinfo)4148 hdaa_audio_disable_useless(struct hdaa_devinfo *devinfo)
4149 {
4150 	struct hdaa_widget *w, *cw;
4151 	struct hdaa_audio_ctl *ctl;
4152 	int done, found, i, j, k;
4153 
4154 	/* Disable useless pins. */
4155 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
4156 		w = hdaa_widget_get(devinfo, i);
4157 		if (w == NULL || w->enable == 0)
4158 			continue;
4159 		if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX) {
4160 			if ((w->wclass.pin.config &
4161 			    HDA_CONFIG_DEFAULTCONF_CONNECTIVITY_MASK) ==
4162 			    HDA_CONFIG_DEFAULTCONF_CONNECTIVITY_NONE) {
4163 				w->enable = 0;
4164 				HDA_BOOTHVERBOSE(
4165 					device_printf(devinfo->dev,
4166 					    " Disabling pin nid %d due"
4167 					    " to None connectivity.\n",
4168 					    w->nid);
4169 				);
4170 			} else if ((w->wclass.pin.config &
4171 			    HDA_CONFIG_DEFAULTCONF_ASSOCIATION_MASK) == 0) {
4172 				w->enable = 0;
4173 				HDA_BOOTHVERBOSE(
4174 					device_printf(devinfo->dev,
4175 					    " Disabling unassociated"
4176 					    " pin nid %d.\n",
4177 					    w->nid);
4178 				);
4179 			}
4180 		}
4181 	}
4182 	do {
4183 		done = 1;
4184 		/* Disable and mute controls for disabled widgets. */
4185 		i = 0;
4186 		while ((ctl = hdaa_audio_ctl_each(devinfo, &i)) != NULL) {
4187 			if (ctl->enable == 0)
4188 				continue;
4189 			if (ctl->widget->enable == 0 ||
4190 			    (ctl->childwidget != NULL &&
4191 			    ctl->childwidget->enable == 0)) {
4192 				ctl->forcemute = 1;
4193 				ctl->muted = HDAA_AMP_MUTE_ALL;
4194 				ctl->left = 0;
4195 				ctl->right = 0;
4196 				ctl->enable = 0;
4197 				if (ctl->ndir == HDAA_CTL_IN)
4198 					ctl->widget->connsenable[ctl->index] = 0;
4199 				done = 0;
4200 				HDA_BOOTHVERBOSE(
4201 					device_printf(devinfo->dev,
4202 					    " Disabling ctl %d nid %d cnid %d due"
4203 					    " to disabled widget.\n", i,
4204 					    ctl->widget->nid,
4205 					    (ctl->childwidget != NULL)?
4206 					    ctl->childwidget->nid:-1);
4207 				);
4208 			}
4209 		}
4210 		/* Disable useless widgets. */
4211 		for (i = devinfo->startnode; i < devinfo->endnode; i++) {
4212 			w = hdaa_widget_get(devinfo, i);
4213 			if (w == NULL || w->enable == 0)
4214 				continue;
4215 			/* Disable inputs with disabled child widgets. */
4216 			for (j = 0; j < w->nconns; j++) {
4217 				if (w->connsenable[j]) {
4218 					cw = hdaa_widget_get(devinfo, w->conns[j]);
4219 					if (cw == NULL || cw->enable == 0) {
4220 						w->connsenable[j] = 0;
4221 						HDA_BOOTHVERBOSE(
4222 							device_printf(devinfo->dev,
4223 							    " Disabling nid %d connection %d due"
4224 							    " to disabled child widget.\n",
4225 							    i, j);
4226 						);
4227 					}
4228 				}
4229 			}
4230 			if (w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_SELECTOR &&
4231 			    w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_MIXER)
4232 				continue;
4233 			/* Disable mixers and selectors without inputs. */
4234 			found = 0;
4235 			for (j = 0; j < w->nconns; j++) {
4236 				if (w->connsenable[j]) {
4237 					found = 1;
4238 					break;
4239 				}
4240 			}
4241 			if (found == 0) {
4242 				w->enable = 0;
4243 				done = 0;
4244 				HDA_BOOTHVERBOSE(
4245 					device_printf(devinfo->dev,
4246 					    " Disabling nid %d due to all it's"
4247 					    " inputs disabled.\n", w->nid);
4248 				);
4249 			}
4250 			/* Disable nodes without consumers. */
4251 			if (w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_SELECTOR &&
4252 			    w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_MIXER)
4253 				continue;
4254 			found = 0;
4255 			for (k = devinfo->startnode; k < devinfo->endnode; k++) {
4256 				cw = hdaa_widget_get(devinfo, k);
4257 				if (cw == NULL || cw->enable == 0)
4258 					continue;
4259 				for (j = 0; j < cw->nconns; j++) {
4260 					if (cw->connsenable[j] && cw->conns[j] == i) {
4261 						found = 1;
4262 						break;
4263 					}
4264 				}
4265 			}
4266 			if (found == 0) {
4267 				w->enable = 0;
4268 				done = 0;
4269 				HDA_BOOTHVERBOSE(
4270 					device_printf(devinfo->dev,
4271 					    " Disabling nid %d due to all it's"
4272 					    " consumers disabled.\n", w->nid);
4273 				);
4274 			}
4275 		}
4276 	} while (done == 0);
4277 
4278 }
4279 
4280 static void
hdaa_audio_disable_unas(struct hdaa_devinfo * devinfo)4281 hdaa_audio_disable_unas(struct hdaa_devinfo *devinfo)
4282 {
4283 	struct hdaa_audio_as *as = devinfo->as;
4284 	struct hdaa_widget *w, *cw;
4285 	struct hdaa_audio_ctl *ctl;
4286 	int i, j, k;
4287 
4288 	/* Disable unassosiated widgets. */
4289 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
4290 		w = hdaa_widget_get(devinfo, i);
4291 		if (w == NULL || w->enable == 0)
4292 			continue;
4293 		if (w->bindas == -1) {
4294 			w->enable = 0;
4295 			HDA_BOOTHVERBOSE(
4296 				device_printf(devinfo->dev,
4297 				    " Disabling unassociated nid %d.\n",
4298 				    w->nid);
4299 			);
4300 		}
4301 	}
4302 	/* Disable input connections on input pin and
4303 	 * output on output. */
4304 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
4305 		w = hdaa_widget_get(devinfo, i);
4306 		if (w == NULL || w->enable == 0)
4307 			continue;
4308 		if (w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
4309 			continue;
4310 		if (w->bindas < 0)
4311 			continue;
4312 		if (as[w->bindas].dir == HDAA_CTL_IN) {
4313 			for (j = 0; j < w->nconns; j++) {
4314 				if (w->connsenable[j] == 0)
4315 					continue;
4316 				w->connsenable[j] = 0;
4317 				HDA_BOOTHVERBOSE(
4318 					device_printf(devinfo->dev,
4319 					    " Disabling connection to input pin "
4320 					    "nid %d conn %d.\n",
4321 					    i, j);
4322 				);
4323 			}
4324 			ctl = hdaa_audio_ctl_amp_get(devinfo, w->nid,
4325 			    HDAA_CTL_IN, -1, 1);
4326 			if (ctl && ctl->enable) {
4327 				ctl->forcemute = 1;
4328 				ctl->muted = HDAA_AMP_MUTE_ALL;
4329 				ctl->left = 0;
4330 				ctl->right = 0;
4331 				ctl->enable = 0;
4332 			}
4333 		} else {
4334 			ctl = hdaa_audio_ctl_amp_get(devinfo, w->nid,
4335 			    HDAA_CTL_OUT, -1, 1);
4336 			if (ctl && ctl->enable) {
4337 				ctl->forcemute = 1;
4338 				ctl->muted = HDAA_AMP_MUTE_ALL;
4339 				ctl->left = 0;
4340 				ctl->right = 0;
4341 				ctl->enable = 0;
4342 			}
4343 			for (k = devinfo->startnode; k < devinfo->endnode; k++) {
4344 				cw = hdaa_widget_get(devinfo, k);
4345 				if (cw == NULL || cw->enable == 0)
4346 					continue;
4347 				for (j = 0; j < cw->nconns; j++) {
4348 					if (cw->connsenable[j] && cw->conns[j] == i) {
4349 						cw->connsenable[j] = 0;
4350 						HDA_BOOTHVERBOSE(
4351 							device_printf(devinfo->dev,
4352 							    " Disabling connection from output pin "
4353 							    "nid %d conn %d cnid %d.\n",
4354 							    k, j, i);
4355 						);
4356 						if (cw->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX &&
4357 						    cw->nconns > 1)
4358 							continue;
4359 						ctl = hdaa_audio_ctl_amp_get(devinfo, k,
4360 					    HDAA_CTL_IN, j, 1);
4361 						if (ctl && ctl->enable) {
4362 							ctl->forcemute = 1;
4363 							ctl->muted = HDAA_AMP_MUTE_ALL;
4364 							ctl->left = 0;
4365 							ctl->right = 0;
4366 							ctl->enable = 0;
4367 						}
4368 					}
4369 				}
4370 			}
4371 		}
4372 	}
4373 }
4374 
4375 static void
hdaa_audio_disable_notselected(struct hdaa_devinfo * devinfo)4376 hdaa_audio_disable_notselected(struct hdaa_devinfo *devinfo)
4377 {
4378 	struct hdaa_audio_as *as = devinfo->as;
4379 	struct hdaa_widget *w;
4380 	int i, j;
4381 
4382 	/* On playback path we can safely disable all unseleted inputs. */
4383 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
4384 		w = hdaa_widget_get(devinfo, i);
4385 		if (w == NULL || w->enable == 0)
4386 			continue;
4387 		if (w->nconns <= 1)
4388 			continue;
4389 		if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_MIXER)
4390 			continue;
4391 		if (w->bindas < 0 || as[w->bindas].dir == HDAA_CTL_IN)
4392 			continue;
4393 		for (j = 0; j < w->nconns; j++) {
4394 			if (w->connsenable[j] == 0)
4395 				continue;
4396 			if (w->selconn < 0 || w->selconn == j)
4397 				continue;
4398 			w->connsenable[j] = 0;
4399 			HDA_BOOTHVERBOSE(
4400 				device_printf(devinfo->dev,
4401 				    " Disabling unselected connection "
4402 				    "nid %d conn %d.\n",
4403 				    i, j);
4404 			);
4405 		}
4406 	}
4407 }
4408 
4409 static void
hdaa_audio_disable_crossas(struct hdaa_devinfo * devinfo)4410 hdaa_audio_disable_crossas(struct hdaa_devinfo *devinfo)
4411 {
4412 	struct hdaa_audio_as *ases = devinfo->as;
4413 	struct hdaa_widget *w, *cw;
4414 	struct hdaa_audio_ctl *ctl;
4415 	int i, j;
4416 
4417 	/* Disable crossassociatement and unwanted crosschannel connections. */
4418 	/* ... using selectors */
4419 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
4420 		w = hdaa_widget_get(devinfo, i);
4421 		if (w == NULL || w->enable == 0)
4422 			continue;
4423 		if (w->nconns <= 1)
4424 			continue;
4425 		if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_MIXER)
4426 			continue;
4427 		/* Allow any -> mix */
4428 		if (w->bindas == -2)
4429 			continue;
4430 		for (j = 0; j < w->nconns; j++) {
4431 			if (w->connsenable[j] == 0)
4432 				continue;
4433 			cw = hdaa_widget_get(devinfo, w->conns[j]);
4434 			if (cw == NULL || w->enable == 0)
4435 				continue;
4436 			/* Allow mix -> out. */
4437 			if (cw->bindas == -2 && w->bindas >= 0 &&
4438 			    ases[w->bindas].dir == HDAA_CTL_OUT)
4439 				continue;
4440 			/* Allow mix -> mixed-in. */
4441 			if (cw->bindas == -2 && w->bindas >= 0 &&
4442 			    ases[w->bindas].mixed)
4443 				continue;
4444 			/* Allow in -> mix. */
4445 			if ((w->pflags & HDAA_ADC_MONITOR) &&
4446 			     cw->bindas >= 0 &&
4447 			     ases[cw->bindas].dir == HDAA_CTL_IN)
4448 				continue;
4449 			/* Allow if have common as/seqs. */
4450 			if (w->bindas == cw->bindas &&
4451 			    (w->bindseqmask & cw->bindseqmask) != 0)
4452 				continue;
4453 			w->connsenable[j] = 0;
4454 			HDA_BOOTHVERBOSE(
4455 				device_printf(devinfo->dev,
4456 				    " Disabling crossassociatement connection "
4457 				    "nid %d conn %d cnid %d.\n",
4458 				    i, j, cw->nid);
4459 			);
4460 		}
4461 	}
4462 	/* ... using controls */
4463 	i = 0;
4464 	while ((ctl = hdaa_audio_ctl_each(devinfo, &i)) != NULL) {
4465 		if (ctl->enable == 0 || ctl->childwidget == NULL)
4466 			continue;
4467 		/* Allow any -> mix */
4468 		if (ctl->widget->bindas == -2)
4469 			continue;
4470 		/* Allow mix -> out. */
4471 		if (ctl->childwidget->bindas == -2 &&
4472 		    ctl->widget->bindas >= 0 &&
4473 		    ases[ctl->widget->bindas].dir == HDAA_CTL_OUT)
4474 			continue;
4475 		/* Allow mix -> mixed-in. */
4476 		if (ctl->childwidget->bindas == -2 &&
4477 		    ctl->widget->bindas >= 0 &&
4478 		    ases[ctl->widget->bindas].mixed)
4479 			continue;
4480 		/* Allow in -> mix. */
4481 		if ((ctl->widget->pflags & HDAA_ADC_MONITOR) &&
4482 		    ctl->childwidget->bindas >= 0 &&
4483 		    ases[ctl->childwidget->bindas].dir == HDAA_CTL_IN)
4484 			continue;
4485 		/* Allow if have common as/seqs. */
4486 		if (ctl->widget->bindas == ctl->childwidget->bindas &&
4487 		    (ctl->widget->bindseqmask & ctl->childwidget->bindseqmask) != 0)
4488 			continue;
4489 		ctl->forcemute = 1;
4490 		ctl->muted = HDAA_AMP_MUTE_ALL;
4491 		ctl->left = 0;
4492 		ctl->right = 0;
4493 		ctl->enable = 0;
4494 		if (ctl->ndir == HDAA_CTL_IN)
4495 			ctl->widget->connsenable[ctl->index] = 0;
4496 		HDA_BOOTHVERBOSE(
4497 			device_printf(devinfo->dev,
4498 			    " Disabling crossassociatement connection "
4499 			    "ctl %d nid %d cnid %d.\n", i,
4500 			    ctl->widget->nid,
4501 			    ctl->childwidget->nid);
4502 		);
4503 	}
4504 
4505 }
4506 
4507 /*
4508  * Find controls to control amplification for source and calculate possible
4509  * amplification range.
4510  */
4511 static int
hdaa_audio_ctl_source_amp(struct hdaa_devinfo * devinfo,nid_t nid,int index,int ossdev,int ctlable,int depth,int * minamp,int * maxamp)4512 hdaa_audio_ctl_source_amp(struct hdaa_devinfo *devinfo, nid_t nid, int index,
4513     int ossdev, int ctlable, int depth, int *minamp, int *maxamp)
4514 {
4515 	struct hdaa_widget *w, *wc;
4516 	struct hdaa_audio_ctl *ctl;
4517 	int i, j, conns = 0, tminamp, tmaxamp, cminamp, cmaxamp, found = 0;
4518 
4519 	if (depth > HDA_PARSE_MAXDEPTH)
4520 		return (found);
4521 
4522 	w = hdaa_widget_get(devinfo, nid);
4523 	if (w == NULL || w->enable == 0)
4524 		return (found);
4525 
4526 	/* Count number of active inputs. */
4527 	if (depth > 0) {
4528 		for (j = 0; j < w->nconns; j++) {
4529 			if (!w->connsenable[j])
4530 				continue;
4531 			conns++;
4532 		}
4533 	}
4534 
4535 	/* If this is not a first step - use input mixer.
4536 	   Pins have common input ctl so care must be taken. */
4537 	if (depth > 0 && ctlable && (conns == 1 ||
4538 	    w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)) {
4539 		ctl = hdaa_audio_ctl_amp_get(devinfo, w->nid, HDAA_CTL_IN,
4540 		    index, 1);
4541 		if (ctl) {
4542 			ctl->ossmask |= (1 << ossdev);
4543 			found++;
4544 			if (*minamp == *maxamp) {
4545 				*minamp += MINQDB(ctl);
4546 				*maxamp += MAXQDB(ctl);
4547 			}
4548 		}
4549 	}
4550 
4551 	/* If widget has own ossdev - not traverse it.
4552 	   It will be traversed on its own. */
4553 	if (w->ossdev >= 0 && depth > 0)
4554 		return (found);
4555 
4556 	/* We must not traverse pin */
4557 	if ((w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_INPUT ||
4558 	    w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX) &&
4559 	    depth > 0)
4560 		return (found);
4561 
4562 	/* record that this widget exports such signal, */
4563 	w->ossmask |= (1 << ossdev);
4564 
4565 	/*
4566 	 * If signals mixed, we can't assign controls farther.
4567 	 * Ignore this on depth zero. Caller must knows why.
4568 	 */
4569 	if (conns > 1 &&
4570 	    w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_MIXER)
4571 		ctlable = 0;
4572 
4573 	if (ctlable) {
4574 		ctl = hdaa_audio_ctl_amp_get(devinfo, w->nid, HDAA_CTL_OUT, -1, 1);
4575 		if (ctl) {
4576 			ctl->ossmask |= (1 << ossdev);
4577 			found++;
4578 			if (*minamp == *maxamp) {
4579 				*minamp += MINQDB(ctl);
4580 				*maxamp += MAXQDB(ctl);
4581 			}
4582 		}
4583 	}
4584 
4585 	cminamp = cmaxamp = 0;
4586 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
4587 		wc = hdaa_widget_get(devinfo, i);
4588 		if (wc == NULL || wc->enable == 0)
4589 			continue;
4590 		for (j = 0; j < wc->nconns; j++) {
4591 			if (wc->connsenable[j] && wc->conns[j] == nid) {
4592 				tminamp = tmaxamp = 0;
4593 				found += hdaa_audio_ctl_source_amp(devinfo,
4594 				    wc->nid, j, ossdev, ctlable, depth + 1,
4595 				    &tminamp, &tmaxamp);
4596 				if (cminamp == 0 && cmaxamp == 0) {
4597 					cminamp = tminamp;
4598 					cmaxamp = tmaxamp;
4599 				} else if (tminamp != tmaxamp) {
4600 					cminamp = imax(cminamp, tminamp);
4601 					cmaxamp = imin(cmaxamp, tmaxamp);
4602 				}
4603 			}
4604 		}
4605 	}
4606 	if (*minamp == *maxamp && cminamp < cmaxamp) {
4607 		*minamp += cminamp;
4608 		*maxamp += cmaxamp;
4609 	}
4610 	return (found);
4611 }
4612 
4613 /*
4614  * Find controls to control amplification for destination and calculate
4615  * possible amplification range.
4616  */
4617 static int
hdaa_audio_ctl_dest_amp(struct hdaa_devinfo * devinfo,nid_t nid,int index,int ossdev,int depth,int * minamp,int * maxamp)4618 hdaa_audio_ctl_dest_amp(struct hdaa_devinfo *devinfo, nid_t nid, int index,
4619     int ossdev, int depth, int *minamp, int *maxamp)
4620 {
4621 	struct hdaa_audio_as *as = devinfo->as;
4622 	struct hdaa_widget *w, *wc;
4623 	struct hdaa_audio_ctl *ctl;
4624 	int i, j, consumers, tminamp, tmaxamp, cminamp, cmaxamp, found = 0;
4625 
4626 	if (depth > HDA_PARSE_MAXDEPTH)
4627 		return (found);
4628 
4629 	w = hdaa_widget_get(devinfo, nid);
4630 	if (w == NULL || w->enable == 0)
4631 		return (found);
4632 
4633 	if (depth > 0) {
4634 		/* If this node produce output for several consumers,
4635 		   we can't touch it. */
4636 		consumers = 0;
4637 		for (i = devinfo->startnode; i < devinfo->endnode; i++) {
4638 			wc = hdaa_widget_get(devinfo, i);
4639 			if (wc == NULL || wc->enable == 0)
4640 				continue;
4641 			for (j = 0; j < wc->nconns; j++) {
4642 				if (wc->connsenable[j] && wc->conns[j] == nid)
4643 					consumers++;
4644 			}
4645 		}
4646 		/* The only exception is if real HP redirection is configured
4647 		   and this is a duplication point.
4648 		   XXX: Actually exception is not completely correct.
4649 		   XXX: Duplication point check is not perfect. */
4650 		if ((consumers == 2 && (w->bindas < 0 ||
4651 		    as[w->bindas].hpredir < 0 || as[w->bindas].fakeredir ||
4652 		    (w->bindseqmask & (1 << 15)) == 0)) ||
4653 		    consumers > 2)
4654 			return (found);
4655 
4656 		/* Else use it's output mixer. */
4657 		ctl = hdaa_audio_ctl_amp_get(devinfo, w->nid,
4658 		    HDAA_CTL_OUT, -1, 1);
4659 		if (ctl) {
4660 			ctl->ossmask |= (1 << ossdev);
4661 			found++;
4662 			if (*minamp == *maxamp) {
4663 				*minamp += MINQDB(ctl);
4664 				*maxamp += MAXQDB(ctl);
4665 			}
4666 		}
4667 	}
4668 
4669 	/* We must not traverse pin */
4670 	if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX &&
4671 	    depth > 0)
4672 		return (found);
4673 
4674 	cminamp = cmaxamp = 0;
4675 	for (i = 0; i < w->nconns; i++) {
4676 		if (w->connsenable[i] == 0)
4677 			continue;
4678 		if (index >= 0 && i != index)
4679 			continue;
4680 		tminamp = tmaxamp = 0;
4681 		ctl = hdaa_audio_ctl_amp_get(devinfo, w->nid,
4682 		    HDAA_CTL_IN, i, 1);
4683 		if (ctl) {
4684 			ctl->ossmask |= (1 << ossdev);
4685 			found++;
4686 			if (*minamp == *maxamp) {
4687 				tminamp += MINQDB(ctl);
4688 				tmaxamp += MAXQDB(ctl);
4689 			}
4690 		}
4691 		found += hdaa_audio_ctl_dest_amp(devinfo, w->conns[i], -1, ossdev,
4692 		    depth + 1, &tminamp, &tmaxamp);
4693 		if (cminamp == 0 && cmaxamp == 0) {
4694 			cminamp = tminamp;
4695 			cmaxamp = tmaxamp;
4696 		} else if (tminamp != tmaxamp) {
4697 			cminamp = imax(cminamp, tminamp);
4698 			cmaxamp = imin(cmaxamp, tmaxamp);
4699 		}
4700 	}
4701 	if (*minamp == *maxamp && cminamp < cmaxamp) {
4702 		*minamp += cminamp;
4703 		*maxamp += cmaxamp;
4704 	}
4705 	return (found);
4706 }
4707 
4708 /*
4709  * Assign OSS names to sound sources
4710  */
4711 static void
hdaa_audio_assign_names(struct hdaa_devinfo * devinfo)4712 hdaa_audio_assign_names(struct hdaa_devinfo *devinfo)
4713 {
4714 	struct hdaa_audio_as *as = devinfo->as;
4715 	struct hdaa_widget *w;
4716 	int i, j;
4717 	int type = -1, use, used = 0;
4718 	static const int types[7][13] = {
4719 	    { SOUND_MIXER_LINE, SOUND_MIXER_LINE1, SOUND_MIXER_LINE2,
4720 	      SOUND_MIXER_LINE3, -1 },	/* line */
4721 	    { SOUND_MIXER_MONITOR, SOUND_MIXER_MIC, -1 }, /* int mic */
4722 	    { SOUND_MIXER_MIC, SOUND_MIXER_MONITOR, -1 }, /* ext mic */
4723 	    { SOUND_MIXER_CD, -1 },	/* cd */
4724 	    { SOUND_MIXER_SPEAKER, -1 },	/* speaker */
4725 	    { SOUND_MIXER_DIGITAL1, SOUND_MIXER_DIGITAL2, SOUND_MIXER_DIGITAL3,
4726 	      -1 },	/* digital */
4727 	    { SOUND_MIXER_LINE, SOUND_MIXER_LINE1, SOUND_MIXER_LINE2,
4728 	      SOUND_MIXER_LINE3, SOUND_MIXER_PHONEIN, SOUND_MIXER_PHONEOUT,
4729 	      SOUND_MIXER_VIDEO, SOUND_MIXER_RADIO, SOUND_MIXER_DIGITAL1,
4730 	      SOUND_MIXER_DIGITAL2, SOUND_MIXER_DIGITAL3, SOUND_MIXER_MONITOR,
4731 	      -1 }	/* others */
4732 	};
4733 
4734 	/* Surely known names */
4735 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
4736 		w = hdaa_widget_get(devinfo, i);
4737 		if (w == NULL || w->enable == 0)
4738 			continue;
4739 		if (w->bindas == -1)
4740 			continue;
4741 		use = -1;
4742 		switch (w->type) {
4743 		case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX:
4744 			if (as[w->bindas].dir == HDAA_CTL_OUT)
4745 				break;
4746 			type = -1;
4747 			switch (w->wclass.pin.config & HDA_CONFIG_DEFAULTCONF_DEVICE_MASK) {
4748 			case HDA_CONFIG_DEFAULTCONF_DEVICE_LINE_IN:
4749 				type = 0;
4750 				break;
4751 			case HDA_CONFIG_DEFAULTCONF_DEVICE_MIC_IN:
4752 				if ((w->wclass.pin.config & HDA_CONFIG_DEFAULTCONF_CONNECTIVITY_MASK)
4753 				    == HDA_CONFIG_DEFAULTCONF_CONNECTIVITY_JACK)
4754 					break;
4755 				type = 1;
4756 				break;
4757 			case HDA_CONFIG_DEFAULTCONF_DEVICE_CD:
4758 				type = 3;
4759 				break;
4760 			case HDA_CONFIG_DEFAULTCONF_DEVICE_SPEAKER:
4761 				type = 4;
4762 				break;
4763 			case HDA_CONFIG_DEFAULTCONF_DEVICE_SPDIF_IN:
4764 			case HDA_CONFIG_DEFAULTCONF_DEVICE_DIGITAL_OTHER_IN:
4765 				type = 5;
4766 				break;
4767 			}
4768 			if (type == -1)
4769 				break;
4770 			j = 0;
4771 			while (types[type][j] >= 0 &&
4772 			    (used & (1 << types[type][j])) != 0) {
4773 				j++;
4774 			}
4775 			if (types[type][j] >= 0)
4776 				use = types[type][j];
4777 			break;
4778 		case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_OUTPUT:
4779 			use = SOUND_MIXER_PCM;
4780 			break;
4781 		case HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_BEEP_WIDGET:
4782 			use = SOUND_MIXER_SPEAKER;
4783 			break;
4784 		default:
4785 			break;
4786 		}
4787 		if (use >= 0) {
4788 			w->ossdev = use;
4789 			used |= (1 << use);
4790 		}
4791 	}
4792 	/* Semi-known names */
4793 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
4794 		w = hdaa_widget_get(devinfo, i);
4795 		if (w == NULL || w->enable == 0)
4796 			continue;
4797 		if (w->ossdev >= 0)
4798 			continue;
4799 		if (w->bindas == -1)
4800 			continue;
4801 		if (w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
4802 			continue;
4803 		if (as[w->bindas].dir == HDAA_CTL_OUT)
4804 			continue;
4805 		type = -1;
4806 		switch (w->wclass.pin.config & HDA_CONFIG_DEFAULTCONF_DEVICE_MASK) {
4807 		case HDA_CONFIG_DEFAULTCONF_DEVICE_LINE_OUT:
4808 		case HDA_CONFIG_DEFAULTCONF_DEVICE_SPEAKER:
4809 		case HDA_CONFIG_DEFAULTCONF_DEVICE_HP_OUT:
4810 		case HDA_CONFIG_DEFAULTCONF_DEVICE_AUX:
4811 			type = 0;
4812 			break;
4813 		case HDA_CONFIG_DEFAULTCONF_DEVICE_MIC_IN:
4814 			type = 2;
4815 			break;
4816 		case HDA_CONFIG_DEFAULTCONF_DEVICE_SPDIF_OUT:
4817 		case HDA_CONFIG_DEFAULTCONF_DEVICE_DIGITAL_OTHER_OUT:
4818 			type = 5;
4819 			break;
4820 		}
4821 		if (type == -1)
4822 			break;
4823 		j = 0;
4824 		while (types[type][j] >= 0 &&
4825 		    (used & (1 << types[type][j])) != 0) {
4826 			j++;
4827 		}
4828 		if (types[type][j] >= 0) {
4829 			w->ossdev = types[type][j];
4830 			used |= (1 << types[type][j]);
4831 		}
4832 	}
4833 	/* Others */
4834 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
4835 		w = hdaa_widget_get(devinfo, i);
4836 		if (w == NULL || w->enable == 0)
4837 			continue;
4838 		if (w->ossdev >= 0)
4839 			continue;
4840 		if (w->bindas == -1)
4841 			continue;
4842 		if (w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
4843 			continue;
4844 		if (as[w->bindas].dir == HDAA_CTL_OUT)
4845 			continue;
4846 		j = 0;
4847 		while (types[6][j] >= 0 &&
4848 		    (used & (1 << types[6][j])) != 0) {
4849 			j++;
4850 		}
4851 		if (types[6][j] >= 0) {
4852 			w->ossdev = types[6][j];
4853 			used |= (1 << types[6][j]);
4854 		}
4855 	}
4856 }
4857 
4858 static void
hdaa_audio_build_tree(struct hdaa_devinfo * devinfo)4859 hdaa_audio_build_tree(struct hdaa_devinfo *devinfo)
4860 {
4861 	struct hdaa_audio_as *as = devinfo->as;
4862 	int j, res;
4863 
4864 	/* Trace all associations in order of their numbers. */
4865 	for (j = 0; j < devinfo->ascnt; j++) {
4866 		if (as[j].enable == 0)
4867 			continue;
4868 		HDA_BOOTVERBOSE(
4869 			device_printf(devinfo->dev,
4870 			    "Tracing association %d (%d)\n", j, as[j].index);
4871 		);
4872 		if (as[j].dir == HDAA_CTL_OUT) {
4873 retry:
4874 			res = hdaa_audio_trace_as_out(devinfo, j, 0);
4875 			if (res == 0 && as[j].hpredir >= 0 &&
4876 			    as[j].fakeredir == 0) {
4877 				/* If CODEC can't do analog HP redirection
4878 				   try to make it using one more DAC. */
4879 				as[j].fakeredir = 1;
4880 				goto retry;
4881 			}
4882 		} else if (as[j].mixed)
4883 			res = hdaa_audio_trace_as_in(devinfo, j);
4884 		else
4885 			res = hdaa_audio_trace_as_in_mch(devinfo, j, 0);
4886 		if (res) {
4887 			HDA_BOOTVERBOSE(
4888 				device_printf(devinfo->dev,
4889 				    "Association %d (%d) trace succeeded\n",
4890 				    j, as[j].index);
4891 			);
4892 		} else {
4893 			HDA_BOOTVERBOSE(
4894 				device_printf(devinfo->dev,
4895 				    "Association %d (%d) trace failed\n",
4896 				    j, as[j].index);
4897 			);
4898 			as[j].enable = 0;
4899 		}
4900 	}
4901 
4902 	/* Look for additional DACs/ADCs. */
4903 	for (j = 0; j < devinfo->ascnt; j++) {
4904 		if (as[j].enable == 0)
4905 			continue;
4906 		hdaa_audio_adddac(devinfo, j);
4907 	}
4908 
4909 	/* Trace mixer and beeper pseudo associations. */
4910 	hdaa_audio_trace_as_extra(devinfo);
4911 }
4912 
4913 /*
4914  * Store in pdevinfo new data about whether and how we can control signal
4915  * for OSS device to/from specified widget.
4916  */
4917 static void
hdaa_adjust_amp(struct hdaa_widget * w,int ossdev,int found,int minamp,int maxamp)4918 hdaa_adjust_amp(struct hdaa_widget *w, int ossdev,
4919     int found, int minamp, int maxamp)
4920 {
4921 	struct hdaa_devinfo *devinfo = w->devinfo;
4922 	struct hdaa_pcm_devinfo *pdevinfo;
4923 
4924 	if (w->bindas >= 0)
4925 		pdevinfo = devinfo->as[w->bindas].pdevinfo;
4926 	else
4927 		pdevinfo = &devinfo->devs[0];
4928 	if (found)
4929 		pdevinfo->ossmask |= (1 << ossdev);
4930 	if (minamp == 0 && maxamp == 0)
4931 		return;
4932 	if (pdevinfo->minamp[ossdev] == 0 && pdevinfo->maxamp[ossdev] == 0) {
4933 		pdevinfo->minamp[ossdev] = minamp;
4934 		pdevinfo->maxamp[ossdev] = maxamp;
4935 	} else {
4936 		pdevinfo->minamp[ossdev] = imax(pdevinfo->minamp[ossdev], minamp);
4937 		pdevinfo->maxamp[ossdev] = imin(pdevinfo->maxamp[ossdev], maxamp);
4938 	}
4939 }
4940 
4941 /*
4942  * Trace signals from/to all possible sources/destionstions to find possible
4943  * recording sources, OSS device control ranges and to assign controls.
4944  */
4945 static void
hdaa_audio_assign_mixers(struct hdaa_devinfo * devinfo)4946 hdaa_audio_assign_mixers(struct hdaa_devinfo *devinfo)
4947 {
4948 	struct hdaa_audio_as *as = devinfo->as;
4949 	struct hdaa_widget *w, *cw;
4950 	int i, j, minamp, maxamp, found;
4951 
4952 	/* Assign mixers to the tree. */
4953 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
4954 		w = hdaa_widget_get(devinfo, i);
4955 		if (w == NULL || w->enable == 0)
4956 			continue;
4957 		minamp = maxamp = 0;
4958 		if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_OUTPUT ||
4959 		    w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_BEEP_WIDGET ||
4960 		    (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX &&
4961 		    as[w->bindas].dir == HDAA_CTL_IN)) {
4962 			if (w->ossdev < 0)
4963 				continue;
4964 			found = hdaa_audio_ctl_source_amp(devinfo, w->nid, -1,
4965 			    w->ossdev, 1, 0, &minamp, &maxamp);
4966 			hdaa_adjust_amp(w, w->ossdev, found, minamp, maxamp);
4967 		} else if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_INPUT) {
4968 			found = hdaa_audio_ctl_dest_amp(devinfo, w->nid, -1,
4969 			    SOUND_MIXER_RECLEV, 0, &minamp, &maxamp);
4970 			hdaa_adjust_amp(w, SOUND_MIXER_RECLEV, found, minamp, maxamp);
4971 		} else if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX &&
4972 		    as[w->bindas].dir == HDAA_CTL_OUT) {
4973 			found = hdaa_audio_ctl_dest_amp(devinfo, w->nid, -1,
4974 			    SOUND_MIXER_VOLUME, 0, &minamp, &maxamp);
4975 			hdaa_adjust_amp(w, SOUND_MIXER_VOLUME, found, minamp, maxamp);
4976 		}
4977 		if (w->ossdev == SOUND_MIXER_IMIX) {
4978 			minamp = maxamp = 0;
4979 			found = hdaa_audio_ctl_source_amp(devinfo, w->nid, -1,
4980 			    w->ossdev, 1, 0, &minamp, &maxamp);
4981 			if (minamp == maxamp) {
4982 				/* If we are unable to control input monitor
4983 				   as source - try to control it as destination. */
4984 				found += hdaa_audio_ctl_dest_amp(devinfo, w->nid, -1,
4985 				    w->ossdev, 0, &minamp, &maxamp);
4986 				w->pflags |= HDAA_IMIX_AS_DST;
4987 			}
4988 			hdaa_adjust_amp(w, w->ossdev, found, minamp, maxamp);
4989 		}
4990 		if (w->pflags & HDAA_ADC_MONITOR) {
4991 			for (j = 0; j < w->nconns; j++) {
4992 				if (!w->connsenable[j])
4993 				    continue;
4994 				cw = hdaa_widget_get(devinfo, w->conns[j]);
4995 				if (cw == NULL || cw->enable == 0)
4996 				    continue;
4997 				if (cw->bindas == -1)
4998 				    continue;
4999 				if (cw->bindas >= 0 &&
5000 				    as[cw->bindas].dir != HDAA_CTL_IN)
5001 					continue;
5002 				minamp = maxamp = 0;
5003 				found = hdaa_audio_ctl_dest_amp(devinfo,
5004 				    w->nid, j, SOUND_MIXER_IGAIN, 0,
5005 				    &minamp, &maxamp);
5006 				hdaa_adjust_amp(w, SOUND_MIXER_IGAIN,
5007 				    found, minamp, maxamp);
5008 			}
5009 		}
5010 	}
5011 }
5012 
5013 static void
hdaa_audio_prepare_pin_ctrl(struct hdaa_devinfo * devinfo)5014 hdaa_audio_prepare_pin_ctrl(struct hdaa_devinfo *devinfo)
5015 {
5016 	struct hdaa_audio_as *as = devinfo->as;
5017 	struct hdaa_widget *w;
5018 	uint32_t pincap;
5019 	int i;
5020 
5021 	for (i = 0; i < devinfo->nodecnt; i++) {
5022 		w = &devinfo->widget[i];
5023 		if (w == NULL)
5024 			continue;
5025 		if (w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX &&
5026 		    w->waspin == 0)
5027 			continue;
5028 
5029 		pincap = w->wclass.pin.cap;
5030 
5031 		/* Disable everything. */
5032 		if (devinfo->init_clear) {
5033 			w->wclass.pin.ctrl &= ~(
5034 			HDA_CMD_SET_PIN_WIDGET_CTRL_HPHN_ENABLE |
5035 			HDA_CMD_SET_PIN_WIDGET_CTRL_OUT_ENABLE |
5036 			HDA_CMD_SET_PIN_WIDGET_CTRL_IN_ENABLE |
5037 			HDA_CMD_SET_PIN_WIDGET_CTRL_VREF_ENABLE_MASK);
5038 		}
5039 
5040 		if (w->enable == 0) {
5041 			/* Pin is unused so left it disabled. */
5042 			continue;
5043 		} else if (w->waspin) {
5044 			/* Enable input for beeper input. */
5045 			w->wclass.pin.ctrl |=
5046 			    HDA_CMD_SET_PIN_WIDGET_CTRL_IN_ENABLE;
5047 		} else if (w->bindas < 0 || as[w->bindas].enable == 0) {
5048 			/* Pin is unused so left it disabled. */
5049 			continue;
5050 		} else if (as[w->bindas].dir == HDAA_CTL_IN) {
5051 			/* Input pin, configure for input. */
5052 			if (HDA_PARAM_PIN_CAP_INPUT_CAP(pincap))
5053 				w->wclass.pin.ctrl |=
5054 				    HDA_CMD_SET_PIN_WIDGET_CTRL_IN_ENABLE;
5055 
5056 			if ((devinfo->quirks & HDAA_QUIRK_IVREF100) &&
5057 			    HDA_PARAM_PIN_CAP_VREF_CTRL_100(pincap))
5058 				w->wclass.pin.ctrl |=
5059 				    HDA_CMD_SET_PIN_WIDGET_CTRL_VREF_ENABLE(
5060 				    HDA_CMD_PIN_WIDGET_CTRL_VREF_ENABLE_100);
5061 			else if ((devinfo->quirks & HDAA_QUIRK_IVREF80) &&
5062 			    HDA_PARAM_PIN_CAP_VREF_CTRL_80(pincap))
5063 				w->wclass.pin.ctrl |=
5064 				    HDA_CMD_SET_PIN_WIDGET_CTRL_VREF_ENABLE(
5065 				    HDA_CMD_PIN_WIDGET_CTRL_VREF_ENABLE_80);
5066 			else if ((devinfo->quirks & HDAA_QUIRK_IVREF50) &&
5067 			    HDA_PARAM_PIN_CAP_VREF_CTRL_50(pincap))
5068 				w->wclass.pin.ctrl |=
5069 				    HDA_CMD_SET_PIN_WIDGET_CTRL_VREF_ENABLE(
5070 				    HDA_CMD_PIN_WIDGET_CTRL_VREF_ENABLE_50);
5071 		} else {
5072 			/* Output pin, configure for output. */
5073 			if (HDA_PARAM_PIN_CAP_OUTPUT_CAP(pincap))
5074 				w->wclass.pin.ctrl |=
5075 				    HDA_CMD_SET_PIN_WIDGET_CTRL_OUT_ENABLE;
5076 
5077 			if (HDA_PARAM_PIN_CAP_HEADPHONE_CAP(pincap) &&
5078 			    (w->wclass.pin.config &
5079 			    HDA_CONFIG_DEFAULTCONF_DEVICE_MASK) ==
5080 			    HDA_CONFIG_DEFAULTCONF_DEVICE_HP_OUT)
5081 				w->wclass.pin.ctrl |=
5082 				    HDA_CMD_SET_PIN_WIDGET_CTRL_HPHN_ENABLE;
5083 
5084 			if ((devinfo->quirks & HDAA_QUIRK_OVREF100) &&
5085 			    HDA_PARAM_PIN_CAP_VREF_CTRL_100(pincap))
5086 				w->wclass.pin.ctrl |=
5087 				    HDA_CMD_SET_PIN_WIDGET_CTRL_VREF_ENABLE(
5088 				    HDA_CMD_PIN_WIDGET_CTRL_VREF_ENABLE_100);
5089 			else if ((devinfo->quirks & HDAA_QUIRK_OVREF80) &&
5090 			    HDA_PARAM_PIN_CAP_VREF_CTRL_80(pincap))
5091 				w->wclass.pin.ctrl |=
5092 				    HDA_CMD_SET_PIN_WIDGET_CTRL_VREF_ENABLE(
5093 				    HDA_CMD_PIN_WIDGET_CTRL_VREF_ENABLE_80);
5094 			else if ((devinfo->quirks & HDAA_QUIRK_OVREF50) &&
5095 			    HDA_PARAM_PIN_CAP_VREF_CTRL_50(pincap))
5096 				w->wclass.pin.ctrl |=
5097 				    HDA_CMD_SET_PIN_WIDGET_CTRL_VREF_ENABLE(
5098 				    HDA_CMD_PIN_WIDGET_CTRL_VREF_ENABLE_50);
5099 		}
5100 	}
5101 }
5102 
5103 static void
hdaa_audio_ctl_commit(struct hdaa_devinfo * devinfo)5104 hdaa_audio_ctl_commit(struct hdaa_devinfo *devinfo)
5105 {
5106 	struct hdaa_audio_ctl *ctl;
5107 	int i, z;
5108 
5109 	i = 0;
5110 	while ((ctl = hdaa_audio_ctl_each(devinfo, &i)) != NULL) {
5111 		if (ctl->enable == 0 || ctl->ossmask != 0) {
5112 			/* Mute disabled and mixer controllable controls.
5113 			 * Last will be initialized by mixer_init().
5114 			 * This expected to reduce click on startup. */
5115 			hdaa_audio_ctl_amp_set(ctl, HDAA_AMP_MUTE_ALL, 0, 0);
5116 			continue;
5117 		}
5118 		/* Init fixed controls to 0dB amplification. */
5119 		z = ctl->offset;
5120 		if (z > ctl->step)
5121 			z = ctl->step;
5122 		hdaa_audio_ctl_amp_set(ctl, HDAA_AMP_MUTE_NONE, z, z);
5123 	}
5124 }
5125 
5126 static void
hdaa_gpio_commit(struct hdaa_devinfo * devinfo)5127 hdaa_gpio_commit(struct hdaa_devinfo *devinfo)
5128 {
5129 	uint32_t gdata, gmask, gdir;
5130 	int i, numgpio;
5131 
5132 	numgpio = HDA_PARAM_GPIO_COUNT_NUM_GPIO(devinfo->gpio_cap);
5133 	if (devinfo->gpio != 0 && numgpio != 0) {
5134 		gdata = hda_command(devinfo->dev,
5135 		    HDA_CMD_GET_GPIO_DATA(0, devinfo->nid));
5136 		gmask = hda_command(devinfo->dev,
5137 		    HDA_CMD_GET_GPIO_ENABLE_MASK(0, devinfo->nid));
5138 		gdir = hda_command(devinfo->dev,
5139 		    HDA_CMD_GET_GPIO_DIRECTION(0, devinfo->nid));
5140 		for (i = 0; i < numgpio; i++) {
5141 			if ((devinfo->gpio & HDAA_GPIO_MASK(i)) ==
5142 			    HDAA_GPIO_SET(i)) {
5143 				gdata |= (1 << i);
5144 				gmask |= (1 << i);
5145 				gdir |= (1 << i);
5146 			} else if ((devinfo->gpio & HDAA_GPIO_MASK(i)) ==
5147 			    HDAA_GPIO_CLEAR(i)) {
5148 				gdata &= ~(1 << i);
5149 				gmask |= (1 << i);
5150 				gdir |= (1 << i);
5151 			} else if ((devinfo->gpio & HDAA_GPIO_MASK(i)) ==
5152 			    HDAA_GPIO_DISABLE(i)) {
5153 				gmask &= ~(1 << i);
5154 			} else if ((devinfo->gpio & HDAA_GPIO_MASK(i)) ==
5155 			    HDAA_GPIO_INPUT(i)) {
5156 				gmask |= (1 << i);
5157 				gdir &= ~(1 << i);
5158 			}
5159 		}
5160 		HDA_BOOTVERBOSE(
5161 			device_printf(devinfo->dev, "GPIO commit\n");
5162 		);
5163 		hda_command(devinfo->dev,
5164 		    HDA_CMD_SET_GPIO_ENABLE_MASK(0, devinfo->nid, gmask));
5165 		hda_command(devinfo->dev,
5166 		    HDA_CMD_SET_GPIO_DIRECTION(0, devinfo->nid, gdir));
5167 		hda_command(devinfo->dev,
5168 		    HDA_CMD_SET_GPIO_DATA(0, devinfo->nid, gdata));
5169 		HDA_BOOTVERBOSE(
5170 			hdaa_dump_gpio(devinfo);
5171 		);
5172 	}
5173 }
5174 
5175 static void
hdaa_gpo_commit(struct hdaa_devinfo * devinfo)5176 hdaa_gpo_commit(struct hdaa_devinfo *devinfo)
5177 {
5178 	uint32_t gdata;
5179 	int i, numgpo;
5180 
5181 	numgpo = HDA_PARAM_GPIO_COUNT_NUM_GPO(devinfo->gpio_cap);
5182 	if (devinfo->gpo != 0 && numgpo != 0) {
5183 		gdata = hda_command(devinfo->dev,
5184 		    HDA_CMD_GET_GPO_DATA(0, devinfo->nid));
5185 		for (i = 0; i < numgpo; i++) {
5186 			if ((devinfo->gpio & HDAA_GPIO_MASK(i)) ==
5187 			    HDAA_GPIO_SET(i)) {
5188 				gdata |= (1 << i);
5189 			} else if ((devinfo->gpio & HDAA_GPIO_MASK(i)) ==
5190 			    HDAA_GPIO_CLEAR(i)) {
5191 				gdata &= ~(1 << i);
5192 			}
5193 		}
5194 		HDA_BOOTVERBOSE(
5195 			device_printf(devinfo->dev, "GPO commit\n");
5196 		);
5197 		hda_command(devinfo->dev,
5198 		    HDA_CMD_SET_GPO_DATA(0, devinfo->nid, gdata));
5199 		HDA_BOOTVERBOSE(
5200 			hdaa_dump_gpo(devinfo);
5201 		);
5202 	}
5203 }
5204 
5205 static void
hdaa_audio_commit(struct hdaa_devinfo * devinfo)5206 hdaa_audio_commit(struct hdaa_devinfo *devinfo)
5207 {
5208 	struct hdaa_widget *w;
5209 	int i;
5210 
5211 	/* Commit controls. */
5212 	hdaa_audio_ctl_commit(devinfo);
5213 
5214 	/* Commit selectors, pins and EAPD. */
5215 	for (i = 0; i < devinfo->nodecnt; i++) {
5216 		w = &devinfo->widget[i];
5217 		if (w == NULL)
5218 			continue;
5219 		if (w->selconn == -1)
5220 			w->selconn = 0;
5221 		if (w->nconns > 0)
5222 			hdaa_widget_connection_select(w, w->selconn);
5223 		if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX ||
5224 		    w->waspin) {
5225 			hda_command(devinfo->dev,
5226 			    HDA_CMD_SET_PIN_WIDGET_CTRL(0, w->nid,
5227 			    w->wclass.pin.ctrl));
5228 		}
5229 		if (w->param.eapdbtl != HDA_INVALID) {
5230 			uint32_t val;
5231 
5232 			val = w->param.eapdbtl;
5233 			if (devinfo->quirks &
5234 			    HDAA_QUIRK_EAPDINV)
5235 				val ^= HDA_CMD_SET_EAPD_BTL_ENABLE_EAPD;
5236 			hda_command(devinfo->dev,
5237 			    HDA_CMD_SET_EAPD_BTL_ENABLE(0, w->nid,
5238 			    val));
5239 		}
5240 	}
5241 
5242 	hdaa_gpio_commit(devinfo);
5243 	hdaa_gpo_commit(devinfo);
5244 }
5245 
5246 static void
hdaa_powerup(struct hdaa_devinfo * devinfo)5247 hdaa_powerup(struct hdaa_devinfo *devinfo)
5248 {
5249 	int i;
5250 
5251 	hda_command(devinfo->dev,
5252 	    HDA_CMD_SET_POWER_STATE(0,
5253 	    devinfo->nid, HDA_CMD_POWER_STATE_D0));
5254 	DELAY(100);
5255 
5256 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
5257 		hda_command(devinfo->dev,
5258 		    HDA_CMD_SET_POWER_STATE(0,
5259 		    i, HDA_CMD_POWER_STATE_D0));
5260 	}
5261 	DELAY(1000);
5262 }
5263 
5264 static int
hdaa_pcmchannel_setup(struct hdaa_chan * ch)5265 hdaa_pcmchannel_setup(struct hdaa_chan *ch)
5266 {
5267 	struct hdaa_devinfo *devinfo = ch->devinfo;
5268 	struct hdaa_audio_as *as = devinfo->as;
5269 	struct hdaa_widget *w;
5270 	uint32_t cap, fmtcap, pcmcap;
5271 	int i, j, ret, channels, onlystereo;
5272 	uint16_t pinset;
5273 
5274 	ch->caps = hdaa_caps;
5275 	ch->caps.fmtlist = ch->fmtlist;
5276 	ch->bit16 = 1;
5277 	ch->bit32 = 0;
5278 	ch->pcmrates[0] = 48000;
5279 	ch->pcmrates[1] = 0;
5280 	ch->stripecap = 0xff;
5281 
5282 	ret = 0;
5283 	channels = 0;
5284 	onlystereo = 1;
5285 	pinset = 0;
5286 	fmtcap = devinfo->supp_stream_formats;
5287 	pcmcap = devinfo->supp_pcm_size_rate;
5288 
5289 	for (i = 0; i < 16; i++) {
5290 		/* Check as is correct */
5291 		if (ch->as < 0)
5292 			break;
5293 		/* Cound only present DACs */
5294 		if (as[ch->as].dacs[ch->asindex][i] <= 0)
5295 			continue;
5296 		/* Ignore duplicates */
5297 		for (j = 0; j < ret; j++) {
5298 			if (ch->io[j] == as[ch->as].dacs[ch->asindex][i])
5299 				break;
5300 		}
5301 		if (j < ret)
5302 			continue;
5303 
5304 		w = hdaa_widget_get(devinfo, as[ch->as].dacs[ch->asindex][i]);
5305 		if (w == NULL || w->enable == 0)
5306 			continue;
5307 		cap = w->param.supp_stream_formats;
5308 		if (!HDA_PARAM_SUPP_STREAM_FORMATS_PCM(cap) &&
5309 		    !HDA_PARAM_SUPP_STREAM_FORMATS_AC3(cap))
5310 			continue;
5311 		/* Many CODECs does not declare AC3 support on SPDIF.
5312 		   I don't beleave that they doesn't support it! */
5313 		if (HDA_PARAM_AUDIO_WIDGET_CAP_DIGITAL(w->param.widget_cap))
5314 			cap |= HDA_PARAM_SUPP_STREAM_FORMATS_AC3_MASK;
5315 		if (ret == 0) {
5316 			fmtcap = cap;
5317 			pcmcap = w->param.supp_pcm_size_rate;
5318 		} else {
5319 			fmtcap &= cap;
5320 			pcmcap &= w->param.supp_pcm_size_rate;
5321 		}
5322 		ch->io[ret++] = as[ch->as].dacs[ch->asindex][i];
5323 		ch->stripecap &= w->wclass.conv.stripecap;
5324 		/* Do not count redirection pin/dac channels. */
5325 		if (i == 15 && as[ch->as].hpredir >= 0)
5326 			continue;
5327 		channels += HDA_PARAM_AUDIO_WIDGET_CAP_CC(w->param.widget_cap) + 1;
5328 		if (HDA_PARAM_AUDIO_WIDGET_CAP_CC(w->param.widget_cap) != 1)
5329 			onlystereo = 0;
5330 		pinset |= (1 << i);
5331 	}
5332 	ch->io[ret] = -1;
5333 	ch->channels = channels;
5334 
5335 	if (as[ch->as].fakeredir)
5336 		ret--;
5337 	/* Standard speaks only about stereo pins and playback, ... */
5338 	if ((!onlystereo) || as[ch->as].mixed)
5339 		pinset = 0;
5340 	/* ..., but there it gives us info about speakers layout. */
5341 	as[ch->as].pinset = pinset;
5342 
5343 	ch->supp_stream_formats = fmtcap;
5344 	ch->supp_pcm_size_rate = pcmcap;
5345 
5346 	/*
5347 	 *  8bit = 0
5348 	 * 16bit = 1
5349 	 * 20bit = 2
5350 	 * 24bit = 3
5351 	 * 32bit = 4
5352 	 */
5353 	if (ret > 0) {
5354 		i = 0;
5355 		if (HDA_PARAM_SUPP_STREAM_FORMATS_PCM(fmtcap)) {
5356 			if (HDA_PARAM_SUPP_PCM_SIZE_RATE_16BIT(pcmcap))
5357 				ch->bit16 = 1;
5358 			else if (HDA_PARAM_SUPP_PCM_SIZE_RATE_8BIT(pcmcap))
5359 				ch->bit16 = 0;
5360 			if (HDA_PARAM_SUPP_PCM_SIZE_RATE_24BIT(pcmcap))
5361 				ch->bit32 = 3;
5362 			else if (HDA_PARAM_SUPP_PCM_SIZE_RATE_20BIT(pcmcap))
5363 				ch->bit32 = 2;
5364 			else if (HDA_PARAM_SUPP_PCM_SIZE_RATE_32BIT(pcmcap))
5365 				ch->bit32 = 4;
5366 			if (!(devinfo->quirks & HDAA_QUIRK_FORCESTEREO)) {
5367 				ch->fmtlist[i++] = SND_FORMAT(AFMT_S16_LE, 1, 0);
5368 				if (ch->bit32)
5369 					ch->fmtlist[i++] = SND_FORMAT(AFMT_S32_LE, 1, 0);
5370 			}
5371 			if (channels >= 2) {
5372 				ch->fmtlist[i++] = SND_FORMAT(AFMT_S16_LE, 2, 0);
5373 				if (ch->bit32)
5374 					ch->fmtlist[i++] = SND_FORMAT(AFMT_S32_LE, 2, 0);
5375 			}
5376 			if (channels >= 3 && !onlystereo) {
5377 				ch->fmtlist[i++] = SND_FORMAT(AFMT_S16_LE, 3, 0);
5378 				if (ch->bit32)
5379 					ch->fmtlist[i++] = SND_FORMAT(AFMT_S32_LE, 3, 0);
5380 				ch->fmtlist[i++] = SND_FORMAT(AFMT_S16_LE, 3, 1);
5381 				if (ch->bit32)
5382 					ch->fmtlist[i++] = SND_FORMAT(AFMT_S32_LE, 3, 1);
5383 			}
5384 			if (channels >= 4) {
5385 				ch->fmtlist[i++] = SND_FORMAT(AFMT_S16_LE, 4, 0);
5386 				if (ch->bit32)
5387 					ch->fmtlist[i++] = SND_FORMAT(AFMT_S32_LE, 4, 0);
5388 				if (!onlystereo) {
5389 					ch->fmtlist[i++] = SND_FORMAT(AFMT_S16_LE, 4, 1);
5390 					if (ch->bit32)
5391 						ch->fmtlist[i++] = SND_FORMAT(AFMT_S32_LE, 4, 1);
5392 				}
5393 			}
5394 			if (channels >= 5 && !onlystereo) {
5395 				ch->fmtlist[i++] = SND_FORMAT(AFMT_S16_LE, 5, 0);
5396 				if (ch->bit32)
5397 					ch->fmtlist[i++] = SND_FORMAT(AFMT_S32_LE, 5, 0);
5398 				ch->fmtlist[i++] = SND_FORMAT(AFMT_S16_LE, 5, 1);
5399 				if (ch->bit32)
5400 					ch->fmtlist[i++] = SND_FORMAT(AFMT_S32_LE, 5, 1);
5401 			}
5402 			if (channels >= 6) {
5403 				ch->fmtlist[i++] = SND_FORMAT(AFMT_S16_LE, 6, 1);
5404 				if (ch->bit32)
5405 					ch->fmtlist[i++] = SND_FORMAT(AFMT_S32_LE, 6, 1);
5406 				if (!onlystereo) {
5407 					ch->fmtlist[i++] = SND_FORMAT(AFMT_S16_LE, 6, 0);
5408 					if (ch->bit32)
5409 						ch->fmtlist[i++] = SND_FORMAT(AFMT_S32_LE, 6, 0);
5410 				}
5411 			}
5412 			if (channels >= 7 && !onlystereo) {
5413 				ch->fmtlist[i++] = SND_FORMAT(AFMT_S16_LE, 7, 0);
5414 				if (ch->bit32)
5415 					ch->fmtlist[i++] = SND_FORMAT(AFMT_S32_LE, 7, 0);
5416 				ch->fmtlist[i++] = SND_FORMAT(AFMT_S16_LE, 7, 1);
5417 				if (ch->bit32)
5418 					ch->fmtlist[i++] = SND_FORMAT(AFMT_S32_LE, 7, 1);
5419 			}
5420 			if (channels >= 8) {
5421 				ch->fmtlist[i++] = SND_FORMAT(AFMT_S16_LE, 8, 1);
5422 				if (ch->bit32)
5423 					ch->fmtlist[i++] = SND_FORMAT(AFMT_S32_LE, 8, 1);
5424 			}
5425 		}
5426 		if (HDA_PARAM_SUPP_STREAM_FORMATS_AC3(fmtcap)) {
5427 			ch->fmtlist[i++] = SND_FORMAT(AFMT_AC3, 2, 0);
5428 			if (channels >= 8) {
5429 				ch->fmtlist[i++] = SND_FORMAT(AFMT_AC3, 8, 1);
5430 			}
5431 		}
5432 		ch->fmtlist[i] = 0;
5433 		i = 0;
5434 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_8KHZ(pcmcap))
5435 			ch->pcmrates[i++] = 8000;
5436 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_11KHZ(pcmcap))
5437 			ch->pcmrates[i++] = 11025;
5438 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_16KHZ(pcmcap))
5439 			ch->pcmrates[i++] = 16000;
5440 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_22KHZ(pcmcap))
5441 			ch->pcmrates[i++] = 22050;
5442 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_32KHZ(pcmcap))
5443 			ch->pcmrates[i++] = 32000;
5444 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_44KHZ(pcmcap))
5445 			ch->pcmrates[i++] = 44100;
5446 		/* if (HDA_PARAM_SUPP_PCM_SIZE_RATE_48KHZ(pcmcap)) */
5447 		ch->pcmrates[i++] = 48000;
5448 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_88KHZ(pcmcap))
5449 			ch->pcmrates[i++] = 88200;
5450 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_96KHZ(pcmcap))
5451 			ch->pcmrates[i++] = 96000;
5452 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_176KHZ(pcmcap))
5453 			ch->pcmrates[i++] = 176400;
5454 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_192KHZ(pcmcap))
5455 			ch->pcmrates[i++] = 192000;
5456 		/* if (HDA_PARAM_SUPP_PCM_SIZE_RATE_384KHZ(pcmcap)) */
5457 		ch->pcmrates[i] = 0;
5458 		if (i > 0) {
5459 			ch->caps.minspeed = ch->pcmrates[0];
5460 			ch->caps.maxspeed = ch->pcmrates[i - 1];
5461 		}
5462 	}
5463 
5464 	return (ret);
5465 }
5466 
5467 static void
hdaa_prepare_pcms(struct hdaa_devinfo * devinfo)5468 hdaa_prepare_pcms(struct hdaa_devinfo *devinfo)
5469 {
5470 	struct hdaa_audio_as *as = devinfo->as;
5471 	int i, j, k, apdev = 0, ardev = 0, dpdev = 0, drdev = 0;
5472 
5473 	for (i = 0; i < devinfo->ascnt; i++) {
5474 		if (as[i].enable == 0)
5475 			continue;
5476 		if (as[i].dir == HDAA_CTL_IN) {
5477 			if (as[i].digital)
5478 				drdev++;
5479 			else
5480 				ardev++;
5481 		} else {
5482 			if (as[i].digital)
5483 				dpdev++;
5484 			else
5485 				apdev++;
5486 		}
5487 	}
5488 	devinfo->num_devs =
5489 	    max(ardev, apdev) + max(drdev, dpdev);
5490 	devinfo->devs = malloc(devinfo->num_devs *
5491 	    sizeof(struct hdaa_pcm_devinfo), M_HDAA, M_ZERO | M_NOWAIT);
5492 	if (devinfo->devs == NULL) {
5493 		device_printf(devinfo->dev,
5494 		    "Unable to allocate memory for devices\n");
5495 		return;
5496 	}
5497 	for (i = 0; i < devinfo->num_devs; i++) {
5498 		devinfo->devs[i].index = i;
5499 		devinfo->devs[i].devinfo = devinfo;
5500 		devinfo->devs[i].playas = -1;
5501 		devinfo->devs[i].recas = -1;
5502 		devinfo->devs[i].digital = 255;
5503 	}
5504 	for (i = 0; i < devinfo->ascnt; i++) {
5505 		if (as[i].enable == 0)
5506 			continue;
5507 		for (j = 0; j < devinfo->num_devs; j++) {
5508 			if (devinfo->devs[j].digital != 255 &&
5509 			    (!devinfo->devs[j].digital) !=
5510 			    (!as[i].digital))
5511 				continue;
5512 			if (as[i].dir == HDAA_CTL_IN) {
5513 				if (devinfo->devs[j].recas >= 0)
5514 					continue;
5515 				devinfo->devs[j].recas = i;
5516 			} else {
5517 				if (devinfo->devs[j].playas >= 0)
5518 					continue;
5519 				devinfo->devs[j].playas = i;
5520 			}
5521 			as[i].pdevinfo = &devinfo->devs[j];
5522 			for (k = 0; k < as[i].num_chans; k++) {
5523 				devinfo->chans[as[i].chans[k]].pdevinfo =
5524 				    &devinfo->devs[j];
5525 			}
5526 			devinfo->devs[j].digital = as[i].digital;
5527 			break;
5528 		}
5529 	}
5530 }
5531 
5532 static void
hdaa_create_pcms(struct hdaa_devinfo * devinfo)5533 hdaa_create_pcms(struct hdaa_devinfo *devinfo)
5534 {
5535 	int i;
5536 
5537 	for (i = 0; i < devinfo->num_devs; i++) {
5538 		struct hdaa_pcm_devinfo *pdevinfo = &devinfo->devs[i];
5539 
5540 		pdevinfo->dev = device_add_child(devinfo->dev, "pcm", DEVICE_UNIT_ANY);
5541 		device_set_ivars(pdevinfo->dev, (void *)pdevinfo);
5542 	}
5543 }
5544 
5545 static void
hdaa_dump_ctls(struct hdaa_pcm_devinfo * pdevinfo,const char * banner,uint32_t flag)5546 hdaa_dump_ctls(struct hdaa_pcm_devinfo *pdevinfo, const char *banner, uint32_t flag)
5547 {
5548 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
5549 	struct hdaa_audio_ctl *ctl;
5550 	char buf[64];
5551 	int i, j, printed = 0;
5552 
5553 	if (flag == 0) {
5554 		flag = ~(SOUND_MASK_VOLUME | SOUND_MASK_PCM |
5555 		    SOUND_MASK_CD | SOUND_MASK_LINE | SOUND_MASK_RECLEV |
5556 		    SOUND_MASK_MIC | SOUND_MASK_SPEAKER | SOUND_MASK_IGAIN |
5557 		    SOUND_MASK_OGAIN | SOUND_MASK_IMIX | SOUND_MASK_MONITOR);
5558 	}
5559 
5560 	for (j = 0; j < SOUND_MIXER_NRDEVICES; j++) {
5561 		if ((flag & (1 << j)) == 0)
5562 			continue;
5563 		i = 0;
5564 		printed = 0;
5565 		while ((ctl = hdaa_audio_ctl_each(devinfo, &i)) != NULL) {
5566 			if (ctl->enable == 0 ||
5567 			    ctl->widget->enable == 0)
5568 				continue;
5569 			if (!((pdevinfo->playas >= 0 &&
5570 			    ctl->widget->bindas == pdevinfo->playas) ||
5571 			    (pdevinfo->recas >= 0 &&
5572 			    ctl->widget->bindas == pdevinfo->recas) ||
5573 			    (ctl->widget->bindas == -2 && pdevinfo->index == 0)))
5574 				continue;
5575 			if ((ctl->ossmask & (1 << j)) == 0)
5576 				continue;
5577 
5578 			if (printed == 0) {
5579 				if (banner != NULL) {
5580 					device_printf(pdevinfo->dev, "%s", banner);
5581 				} else {
5582 					device_printf(pdevinfo->dev, "Unknown Ctl");
5583 				}
5584 				printf(" (OSS: %s)",
5585 				    hdaa_audio_ctl_ossmixer_mask2allname(1 << j,
5586 				    buf, sizeof(buf)));
5587 				if (pdevinfo->ossmask & (1 << j)) {
5588 					printf(": %+d/%+ddB\n",
5589 					    pdevinfo->minamp[j] / 4,
5590 					    pdevinfo->maxamp[j] / 4);
5591 				} else
5592 					printf("\n");
5593 				printed = 1;
5594 			}
5595 			device_printf(pdevinfo->dev, "   +- ctl %2d (nid %3d %s", i,
5596 				ctl->widget->nid,
5597 				(ctl->ndir == HDAA_CTL_IN)?"in ":"out");
5598 			if (ctl->ndir == HDAA_CTL_IN && ctl->ndir == ctl->dir)
5599 				printf(" %2d): ", ctl->index);
5600 			else
5601 				printf("):    ");
5602 			if (ctl->step > 0) {
5603 				printf("%+d/%+ddB (%d steps)%s\n",
5604 				    MINQDB(ctl) / 4,
5605 				    MAXQDB(ctl) / 4,
5606 				    ctl->step + 1,
5607 				    ctl->mute?" + mute":"");
5608 			} else
5609 				printf("%s\n", ctl->mute?"mute":"");
5610 		}
5611 	}
5612 	if (printed)
5613 		device_printf(pdevinfo->dev, "\n");
5614 }
5615 
5616 static void
hdaa_dump_audio_formats(device_t dev,uint32_t fcap,uint32_t pcmcap)5617 hdaa_dump_audio_formats(device_t dev, uint32_t fcap, uint32_t pcmcap)
5618 {
5619 	uint32_t cap;
5620 
5621 	cap = fcap;
5622 	if (cap != 0) {
5623 		device_printf(dev, "     Stream cap: 0x%08x", cap);
5624 		if (HDA_PARAM_SUPP_STREAM_FORMATS_AC3(cap))
5625 			printf(" AC3");
5626 		if (HDA_PARAM_SUPP_STREAM_FORMATS_FLOAT32(cap))
5627 			printf(" FLOAT32");
5628 		if (HDA_PARAM_SUPP_STREAM_FORMATS_PCM(cap))
5629 			printf(" PCM");
5630 		printf("\n");
5631 	}
5632 	cap = pcmcap;
5633 	if (cap != 0) {
5634 		device_printf(dev, "        PCM cap: 0x%08x", cap);
5635 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_8BIT(cap))
5636 			printf(" 8");
5637 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_16BIT(cap))
5638 			printf(" 16");
5639 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_20BIT(cap))
5640 			printf(" 20");
5641 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_24BIT(cap))
5642 			printf(" 24");
5643 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_32BIT(cap))
5644 			printf(" 32");
5645 		printf(" bits,");
5646 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_8KHZ(cap))
5647 			printf(" 8");
5648 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_11KHZ(cap))
5649 			printf(" 11");
5650 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_16KHZ(cap))
5651 			printf(" 16");
5652 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_22KHZ(cap))
5653 			printf(" 22");
5654 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_32KHZ(cap))
5655 			printf(" 32");
5656 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_44KHZ(cap))
5657 			printf(" 44");
5658 		printf(" 48");
5659 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_88KHZ(cap))
5660 			printf(" 88");
5661 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_96KHZ(cap))
5662 			printf(" 96");
5663 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_176KHZ(cap))
5664 			printf(" 176");
5665 		if (HDA_PARAM_SUPP_PCM_SIZE_RATE_192KHZ(cap))
5666 			printf(" 192");
5667 		printf(" KHz\n");
5668 	}
5669 }
5670 
5671 static void
hdaa_dump_pin(struct hdaa_widget * w)5672 hdaa_dump_pin(struct hdaa_widget *w)
5673 {
5674 	uint32_t pincap;
5675 
5676 	pincap = w->wclass.pin.cap;
5677 
5678 	device_printf(w->devinfo->dev, "        Pin cap: 0x%08x", pincap);
5679 	if (HDA_PARAM_PIN_CAP_IMP_SENSE_CAP(pincap))
5680 		printf(" ISC");
5681 	if (HDA_PARAM_PIN_CAP_TRIGGER_REQD(pincap))
5682 		printf(" TRQD");
5683 	if (HDA_PARAM_PIN_CAP_PRESENCE_DETECT_CAP(pincap))
5684 		printf(" PDC");
5685 	if (HDA_PARAM_PIN_CAP_HEADPHONE_CAP(pincap))
5686 		printf(" HP");
5687 	if (HDA_PARAM_PIN_CAP_OUTPUT_CAP(pincap))
5688 		printf(" OUT");
5689 	if (HDA_PARAM_PIN_CAP_INPUT_CAP(pincap))
5690 		printf(" IN");
5691 	if (HDA_PARAM_PIN_CAP_BALANCED_IO_PINS(pincap))
5692 		printf(" BAL");
5693 	if (HDA_PARAM_PIN_CAP_HDMI(pincap))
5694 		printf(" HDMI");
5695 	if (HDA_PARAM_PIN_CAP_VREF_CTRL(pincap)) {
5696 		printf(" VREF[");
5697 		if (HDA_PARAM_PIN_CAP_VREF_CTRL_50(pincap))
5698 			printf(" 50");
5699 		if (HDA_PARAM_PIN_CAP_VREF_CTRL_80(pincap))
5700 			printf(" 80");
5701 		if (HDA_PARAM_PIN_CAP_VREF_CTRL_100(pincap))
5702 			printf(" 100");
5703 		if (HDA_PARAM_PIN_CAP_VREF_CTRL_GROUND(pincap))
5704 			printf(" GROUND");
5705 		if (HDA_PARAM_PIN_CAP_VREF_CTRL_HIZ(pincap))
5706 			printf(" HIZ");
5707 		printf(" ]");
5708 	}
5709 	if (HDA_PARAM_PIN_CAP_EAPD_CAP(pincap))
5710 		printf(" EAPD");
5711 	if (HDA_PARAM_PIN_CAP_DP(pincap))
5712 		printf(" DP");
5713 	if (HDA_PARAM_PIN_CAP_HBR(pincap))
5714 		printf(" HBR");
5715 	printf("\n");
5716 	device_printf(w->devinfo->dev, "     Pin config: 0x%08x\n",
5717 	    w->wclass.pin.config);
5718 	device_printf(w->devinfo->dev, "    Pin control: 0x%08x", w->wclass.pin.ctrl);
5719 	if (w->wclass.pin.ctrl & HDA_CMD_SET_PIN_WIDGET_CTRL_HPHN_ENABLE)
5720 		printf(" HP");
5721 	if (w->wclass.pin.ctrl & HDA_CMD_SET_PIN_WIDGET_CTRL_IN_ENABLE)
5722 		printf(" IN");
5723 	if (w->wclass.pin.ctrl & HDA_CMD_SET_PIN_WIDGET_CTRL_OUT_ENABLE)
5724 		printf(" OUT");
5725 	if (HDA_PARAM_AUDIO_WIDGET_CAP_DIGITAL(w->param.widget_cap)) {
5726 		if ((w->wclass.pin.ctrl &
5727 		    HDA_CMD_SET_PIN_WIDGET_CTRL_VREF_ENABLE_MASK) == 0x03)
5728 			printf(" HBR");
5729 		else if ((w->wclass.pin.ctrl &
5730 		    HDA_CMD_SET_PIN_WIDGET_CTRL_VREF_ENABLE_MASK) != 0)
5731 			printf(" EPTs");
5732 	} else {
5733 		if ((w->wclass.pin.ctrl &
5734 		    HDA_CMD_SET_PIN_WIDGET_CTRL_VREF_ENABLE_MASK) != 0)
5735 			printf(" VREFs");
5736 	}
5737 	printf("\n");
5738 }
5739 
5740 static void
hdaa_dump_pin_config(struct hdaa_widget * w,uint32_t conf)5741 hdaa_dump_pin_config(struct hdaa_widget *w, uint32_t conf)
5742 {
5743 
5744 	device_printf(w->devinfo->dev, "%2d %08x %-2d %-2d "
5745 	    "%-13s %-5s %-7s %-10s %-7s %d%s\n",
5746 	    w->nid, conf,
5747 	    HDA_CONFIG_DEFAULTCONF_ASSOCIATION(conf),
5748 	    HDA_CONFIG_DEFAULTCONF_SEQUENCE(conf),
5749 	    HDA_DEVS[HDA_CONFIG_DEFAULTCONF_DEVICE(conf)],
5750 	    HDA_CONNS[HDA_CONFIG_DEFAULTCONF_CONNECTIVITY(conf)],
5751 	    HDA_CONNECTORS[HDA_CONFIG_DEFAULTCONF_CONNECTION_TYPE(conf)],
5752 	    HDA_LOCS[HDA_CONFIG_DEFAULTCONF_LOCATION(conf)],
5753 	    HDA_COLORS[HDA_CONFIG_DEFAULTCONF_COLOR(conf)],
5754 	    HDA_CONFIG_DEFAULTCONF_MISC(conf),
5755 	    (w->enable == 0)?" DISA":"");
5756 }
5757 
5758 static void
hdaa_dump_pin_configs(struct hdaa_devinfo * devinfo)5759 hdaa_dump_pin_configs(struct hdaa_devinfo *devinfo)
5760 {
5761 	struct hdaa_widget *w;
5762 	int i;
5763 
5764 	device_printf(devinfo->dev, "nid   0x    as seq "
5765 	    "device       conn  jack    loc        color   misc\n");
5766 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
5767 		w = hdaa_widget_get(devinfo, i);
5768 		if (w == NULL)
5769 			continue;
5770 		if (w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
5771 			continue;
5772 		hdaa_dump_pin_config(w, w->wclass.pin.config);
5773 	}
5774 }
5775 
5776 static void
hdaa_dump_amp(device_t dev,uint32_t cap,const char * banner)5777 hdaa_dump_amp(device_t dev, uint32_t cap, const char *banner)
5778 {
5779 	int offset, size, step;
5780 
5781 	offset = HDA_PARAM_OUTPUT_AMP_CAP_OFFSET(cap);
5782 	size = HDA_PARAM_OUTPUT_AMP_CAP_STEPSIZE(cap);
5783 	step = HDA_PARAM_OUTPUT_AMP_CAP_NUMSTEPS(cap);
5784 	device_printf(dev, "     %s amp: 0x%08x "
5785 	    "mute=%d step=%d size=%d offset=%d (%+d/%+ddB)\n",
5786 	    banner, cap,
5787 	    HDA_PARAM_OUTPUT_AMP_CAP_MUTE_CAP(cap),
5788 	    step, size, offset,
5789 	    ((0 - offset) * (size + 1)) / 4,
5790 	    ((step - offset) * (size + 1)) / 4);
5791 }
5792 
5793 static void
hdaa_dump_nodes(struct hdaa_devinfo * devinfo)5794 hdaa_dump_nodes(struct hdaa_devinfo *devinfo)
5795 {
5796 	struct hdaa_widget *w, *cw;
5797 	char buf[64];
5798 	int i, j;
5799 
5800 	device_printf(devinfo->dev, "\n");
5801 	device_printf(devinfo->dev, "Default parameters:\n");
5802 	hdaa_dump_audio_formats(devinfo->dev,
5803 	    devinfo->supp_stream_formats,
5804 	    devinfo->supp_pcm_size_rate);
5805 	hdaa_dump_amp(devinfo->dev, devinfo->inamp_cap, " Input");
5806 	hdaa_dump_amp(devinfo->dev, devinfo->outamp_cap, "Output");
5807 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
5808 		w = hdaa_widget_get(devinfo, i);
5809 		if (w == NULL) {
5810 			device_printf(devinfo->dev, "Ghost widget nid=%d\n", i);
5811 			continue;
5812 		}
5813 		device_printf(devinfo->dev, "\n");
5814 		device_printf(devinfo->dev, "            nid: %d%s\n", w->nid,
5815 		    (w->enable == 0) ? " [DISABLED]" : "");
5816 		device_printf(devinfo->dev, "           Name: %s\n", w->name);
5817 		device_printf(devinfo->dev, "     Widget cap: 0x%08x",
5818 		    w->param.widget_cap);
5819 		if (w->param.widget_cap & 0x0ee1) {
5820 			if (HDA_PARAM_AUDIO_WIDGET_CAP_LR_SWAP(w->param.widget_cap))
5821 			    printf(" LRSWAP");
5822 			if (HDA_PARAM_AUDIO_WIDGET_CAP_POWER_CTRL(w->param.widget_cap))
5823 			    printf(" PWR");
5824 			if (HDA_PARAM_AUDIO_WIDGET_CAP_DIGITAL(w->param.widget_cap))
5825 			    printf(" DIGITAL");
5826 			if (HDA_PARAM_AUDIO_WIDGET_CAP_UNSOL_CAP(w->param.widget_cap))
5827 			    printf(" UNSOL");
5828 			if (HDA_PARAM_AUDIO_WIDGET_CAP_PROC_WIDGET(w->param.widget_cap))
5829 			    printf(" PROC");
5830 			if (HDA_PARAM_AUDIO_WIDGET_CAP_STRIPE(w->param.widget_cap))
5831 			    printf(" STRIPE(x%d)",
5832 				1 << (fls(w->wclass.conv.stripecap) - 1));
5833 			j = HDA_PARAM_AUDIO_WIDGET_CAP_CC(w->param.widget_cap);
5834 			if (j == 1)
5835 			    printf(" STEREO");
5836 			else if (j > 1)
5837 			    printf(" %dCH", j + 1);
5838 		}
5839 		printf("\n");
5840 		if (w->bindas != -1) {
5841 			device_printf(devinfo->dev, "    Association: %d (0x%04x)\n",
5842 			    w->bindas, w->bindseqmask);
5843 		}
5844 		if (w->ossmask != 0 || w->ossdev >= 0) {
5845 			device_printf(devinfo->dev, "            OSS: %s",
5846 			    hdaa_audio_ctl_ossmixer_mask2allname(w->ossmask, buf, sizeof(buf)));
5847 			if (w->ossdev >= 0)
5848 			    printf(" (%s)", ossnames[w->ossdev]);
5849 			printf("\n");
5850 		}
5851 		if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_OUTPUT ||
5852 		    w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_INPUT) {
5853 			hdaa_dump_audio_formats(devinfo->dev,
5854 			    w->param.supp_stream_formats,
5855 			    w->param.supp_pcm_size_rate);
5856 		} else if (w->type ==
5857 		    HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX || w->waspin)
5858 			hdaa_dump_pin(w);
5859 		if (w->param.eapdbtl != HDA_INVALID)
5860 			device_printf(devinfo->dev, "           EAPD: 0x%08x\n",
5861 			    w->param.eapdbtl);
5862 		if (HDA_PARAM_AUDIO_WIDGET_CAP_OUT_AMP(w->param.widget_cap) &&
5863 		    w->param.outamp_cap != 0)
5864 			hdaa_dump_amp(devinfo->dev, w->param.outamp_cap, "Output");
5865 		if (HDA_PARAM_AUDIO_WIDGET_CAP_IN_AMP(w->param.widget_cap) &&
5866 		    w->param.inamp_cap != 0)
5867 			hdaa_dump_amp(devinfo->dev, w->param.inamp_cap, " Input");
5868 		if (w->nconns > 0)
5869 			device_printf(devinfo->dev, "    Connections: %d\n", w->nconns);
5870 		for (j = 0; j < w->nconns; j++) {
5871 			cw = hdaa_widget_get(devinfo, w->conns[j]);
5872 			device_printf(devinfo->dev, "          + %s<- nid=%d [%s]",
5873 			    (w->connsenable[j] == 0)?"[DISABLED] ":"",
5874 			    w->conns[j], (cw == NULL) ? "GHOST!" : cw->name);
5875 			if (cw == NULL)
5876 				printf(" [UNKNOWN]");
5877 			else if (cw->enable == 0)
5878 				printf(" [DISABLED]");
5879 			if (w->nconns > 1 && w->selconn == j && w->type !=
5880 			    HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_MIXER)
5881 				printf(" (selected)");
5882 			printf("\n");
5883 		}
5884 	}
5885 
5886 }
5887 
5888 static void
hdaa_dump_dst_nid(struct hdaa_pcm_devinfo * pdevinfo,nid_t nid,int depth)5889 hdaa_dump_dst_nid(struct hdaa_pcm_devinfo *pdevinfo, nid_t nid, int depth)
5890 {
5891 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
5892 	struct hdaa_widget *w, *cw;
5893 	char buf[64];
5894 	int i;
5895 
5896 	if (depth > HDA_PARSE_MAXDEPTH)
5897 		return;
5898 
5899 	w = hdaa_widget_get(devinfo, nid);
5900 	if (w == NULL || w->enable == 0)
5901 		return;
5902 
5903 	if (depth == 0)
5904 		device_printf(pdevinfo->dev, "%*s", 4, "");
5905 	else
5906 		device_printf(pdevinfo->dev, "%*s  + <- ", 4 + (depth - 1) * 7, "");
5907 	printf("nid=%d [%s]", w->nid, w->name);
5908 
5909 	if (depth > 0) {
5910 		if (w->ossmask == 0) {
5911 			printf("\n");
5912 			return;
5913 		}
5914 		printf(" [src: %s]",
5915 		    hdaa_audio_ctl_ossmixer_mask2allname(
5916 			w->ossmask, buf, sizeof(buf)));
5917 		if (w->ossdev >= 0) {
5918 			printf("\n");
5919 			return;
5920 		}
5921 	}
5922 	printf("\n");
5923 
5924 	for (i = 0; i < w->nconns; i++) {
5925 		if (w->connsenable[i] == 0)
5926 			continue;
5927 		cw = hdaa_widget_get(devinfo, w->conns[i]);
5928 		if (cw == NULL || cw->enable == 0 || cw->bindas == -1)
5929 			continue;
5930 		hdaa_dump_dst_nid(pdevinfo, w->conns[i], depth + 1);
5931 	}
5932 
5933 }
5934 
5935 static void
hdaa_dump_dac(struct hdaa_pcm_devinfo * pdevinfo)5936 hdaa_dump_dac(struct hdaa_pcm_devinfo *pdevinfo)
5937 {
5938 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
5939 	struct hdaa_audio_as *as;
5940 	struct hdaa_widget *w;
5941 	nid_t *nids;
5942 	int chid, i;
5943 
5944 	if (pdevinfo->playas < 0)
5945 		return;
5946 
5947 	device_printf(pdevinfo->dev, "Playback:\n");
5948 
5949 	chid = devinfo->as[pdevinfo->playas].chans[0];
5950 	hdaa_dump_audio_formats(pdevinfo->dev,
5951 	    devinfo->chans[chid].supp_stream_formats,
5952 	    devinfo->chans[chid].supp_pcm_size_rate);
5953 	for (i = 0; i < devinfo->as[pdevinfo->playas].num_chans; i++) {
5954 		chid = devinfo->as[pdevinfo->playas].chans[i];
5955 		device_printf(pdevinfo->dev, "            DAC:");
5956 		for (nids = devinfo->chans[chid].io; *nids != -1; nids++)
5957 			printf(" %d", *nids);
5958 		printf("\n");
5959 	}
5960 
5961 	as = &devinfo->as[pdevinfo->playas];
5962 	for (i = 0; i < 16; i++) {
5963 		if (as->pins[i] <= 0)
5964 			continue;
5965 		w = hdaa_widget_get(devinfo, as->pins[i]);
5966 		if (w == NULL || w->enable == 0)
5967 			continue;
5968 		device_printf(pdevinfo->dev, "\n");
5969 		hdaa_dump_dst_nid(pdevinfo, as->pins[i], 0);
5970 	}
5971 	device_printf(pdevinfo->dev, "\n");
5972 }
5973 
5974 static void
hdaa_dump_adc(struct hdaa_pcm_devinfo * pdevinfo)5975 hdaa_dump_adc(struct hdaa_pcm_devinfo *pdevinfo)
5976 {
5977 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
5978 	struct hdaa_widget *w;
5979 	nid_t *nids;
5980 	int chid, i;
5981 
5982 	if (pdevinfo->recas < 0)
5983 		return;
5984 
5985 	device_printf(pdevinfo->dev, "Record:\n");
5986 
5987 	chid = devinfo->as[pdevinfo->recas].chans[0];
5988 	hdaa_dump_audio_formats(pdevinfo->dev,
5989 	    devinfo->chans[chid].supp_stream_formats,
5990 	    devinfo->chans[chid].supp_pcm_size_rate);
5991 	for (i = 0; i < devinfo->as[pdevinfo->recas].num_chans; i++) {
5992 		chid = devinfo->as[pdevinfo->recas].chans[i];
5993 		device_printf(pdevinfo->dev, "            ADC:");
5994 		for (nids = devinfo->chans[chid].io; *nids != -1; nids++)
5995 			printf(" %d", *nids);
5996 		printf("\n");
5997 	}
5998 
5999 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
6000 		w = hdaa_widget_get(devinfo, i);
6001 		if (w == NULL || w->enable == 0)
6002 			continue;
6003 		if (w->type != HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_AUDIO_INPUT)
6004 			continue;
6005 		if (w->bindas != pdevinfo->recas)
6006 			continue;
6007 		device_printf(pdevinfo->dev, "\n");
6008 		hdaa_dump_dst_nid(pdevinfo, i, 0);
6009 	}
6010 	device_printf(pdevinfo->dev, "\n");
6011 }
6012 
6013 static void
hdaa_dump_mix(struct hdaa_pcm_devinfo * pdevinfo)6014 hdaa_dump_mix(struct hdaa_pcm_devinfo *pdevinfo)
6015 {
6016 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
6017 	struct hdaa_widget *w;
6018 	int i;
6019 	int printed = 0;
6020 
6021 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
6022 		w = hdaa_widget_get(devinfo, i);
6023 		if (w == NULL || w->enable == 0)
6024 			continue;
6025 		if (w->ossdev != SOUND_MIXER_IMIX)
6026 			continue;
6027 		if (w->bindas != pdevinfo->recas)
6028 			continue;
6029 		if (printed == 0) {
6030 			printed = 1;
6031 			device_printf(pdevinfo->dev, "Input Mix:\n");
6032 		}
6033 		device_printf(pdevinfo->dev, "\n");
6034 		hdaa_dump_dst_nid(pdevinfo, i, 0);
6035 	}
6036 	if (printed)
6037 		device_printf(pdevinfo->dev, "\n");
6038 }
6039 
6040 static void
hdaa_pindump(device_t dev)6041 hdaa_pindump(device_t dev)
6042 {
6043 	struct hdaa_devinfo *devinfo = device_get_softc(dev);
6044 	struct hdaa_widget *w;
6045 	uint32_t res, pincap, delay;
6046 	int i;
6047 
6048 	device_printf(dev, "Dumping AFG pins:\n");
6049 	device_printf(dev, "nid   0x    as seq "
6050 	    "device       conn  jack    loc        color   misc\n");
6051 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
6052 		w = hdaa_widget_get(devinfo, i);
6053 		if (w == NULL || w->type !=
6054 		    HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
6055 			continue;
6056 		hdaa_dump_pin_config(w, w->wclass.pin.config);
6057 		pincap = w->wclass.pin.cap;
6058 		device_printf(dev, "    Caps: %2s %3s %2s %4s %4s",
6059 		    HDA_PARAM_PIN_CAP_INPUT_CAP(pincap)?"IN":"",
6060 		    HDA_PARAM_PIN_CAP_OUTPUT_CAP(pincap)?"OUT":"",
6061 		    HDA_PARAM_PIN_CAP_HEADPHONE_CAP(pincap)?"HP":"",
6062 		    HDA_PARAM_PIN_CAP_EAPD_CAP(pincap)?"EAPD":"",
6063 		    HDA_PARAM_PIN_CAP_VREF_CTRL(pincap)?"VREF":"");
6064 		if (HDA_PARAM_PIN_CAP_IMP_SENSE_CAP(pincap) ||
6065 		    HDA_PARAM_PIN_CAP_PRESENCE_DETECT_CAP(pincap)) {
6066 			if (HDA_PARAM_PIN_CAP_TRIGGER_REQD(pincap)) {
6067 				delay = 0;
6068 				hda_command(dev,
6069 				    HDA_CMD_SET_PIN_SENSE(0, w->nid, 0));
6070 				do {
6071 					res = hda_command(dev,
6072 					    HDA_CMD_GET_PIN_SENSE(0, w->nid));
6073 					if (res != 0x7fffffff && res != 0xffffffff)
6074 						break;
6075 					DELAY(10);
6076 				} while (++delay < 10000);
6077 			} else {
6078 				delay = 0;
6079 				res = hda_command(dev, HDA_CMD_GET_PIN_SENSE(0,
6080 				    w->nid));
6081 			}
6082 			printf(" Sense: 0x%08x (%sconnected%s)", res,
6083 			    (res & HDA_CMD_GET_PIN_SENSE_PRESENCE_DETECT) ?
6084 			     "" : "dis",
6085 			    (HDA_PARAM_AUDIO_WIDGET_CAP_DIGITAL(w->param.widget_cap) &&
6086 			     (res & HDA_CMD_GET_PIN_SENSE_ELD_VALID)) ?
6087 			      ", ELD valid" : "");
6088 			if (delay > 0)
6089 				printf(" delay %dus", delay * 10);
6090 		}
6091 		printf("\n");
6092 	}
6093 	device_printf(dev,
6094 	    "NumGPIO=%d NumGPO=%d NumGPI=%d GPIWake=%d GPIUnsol=%d\n",
6095 	    HDA_PARAM_GPIO_COUNT_NUM_GPIO(devinfo->gpio_cap),
6096 	    HDA_PARAM_GPIO_COUNT_NUM_GPO(devinfo->gpio_cap),
6097 	    HDA_PARAM_GPIO_COUNT_NUM_GPI(devinfo->gpio_cap),
6098 	    HDA_PARAM_GPIO_COUNT_GPI_WAKE(devinfo->gpio_cap),
6099 	    HDA_PARAM_GPIO_COUNT_GPI_UNSOL(devinfo->gpio_cap));
6100 	hdaa_dump_gpi(devinfo);
6101 	hdaa_dump_gpio(devinfo);
6102 	hdaa_dump_gpo(devinfo);
6103 }
6104 
6105 static void
hdaa_configure(device_t dev)6106 hdaa_configure(device_t dev)
6107 {
6108 	struct hdaa_devinfo *devinfo = device_get_softc(dev);
6109 	struct hdaa_audio_ctl *ctl;
6110 	int i;
6111 
6112 	HDA_BOOTHVERBOSE(
6113 		device_printf(dev, "Applying built-in patches...\n");
6114 	);
6115 	hdaa_patch(devinfo);
6116 	HDA_BOOTHVERBOSE(
6117 		device_printf(dev, "Applying local patches...\n");
6118 	);
6119 	hdaa_local_patch(devinfo);
6120 	hdaa_audio_postprocess(devinfo);
6121 	HDA_BOOTHVERBOSE(
6122 		device_printf(dev, "Parsing Ctls...\n");
6123 	);
6124 	hdaa_audio_ctl_parse(devinfo);
6125 	HDA_BOOTHVERBOSE(
6126 		device_printf(dev, "Disabling nonaudio...\n");
6127 	);
6128 	hdaa_audio_disable_nonaudio(devinfo);
6129 	HDA_BOOTHVERBOSE(
6130 		device_printf(dev, "Disabling useless...\n");
6131 	);
6132 	hdaa_audio_disable_useless(devinfo);
6133 	HDA_BOOTVERBOSE(
6134 		device_printf(dev, "Patched pins configuration:\n");
6135 		hdaa_dump_pin_configs(devinfo);
6136 	);
6137 	HDA_BOOTHVERBOSE(
6138 		device_printf(dev, "Parsing pin associations...\n");
6139 	);
6140 	hdaa_audio_as_parse(devinfo);
6141 	HDA_BOOTHVERBOSE(
6142 		device_printf(dev, "Building AFG tree...\n");
6143 	);
6144 	hdaa_audio_build_tree(devinfo);
6145 	HDA_BOOTHVERBOSE(
6146 		device_printf(dev, "Disabling unassociated "
6147 		    "widgets...\n");
6148 	);
6149 	hdaa_audio_disable_unas(devinfo);
6150 	HDA_BOOTHVERBOSE(
6151 		device_printf(dev, "Disabling nonselected "
6152 		    "inputs...\n");
6153 	);
6154 	hdaa_audio_disable_notselected(devinfo);
6155 	HDA_BOOTHVERBOSE(
6156 		device_printf(dev, "Disabling useless...\n");
6157 	);
6158 	hdaa_audio_disable_useless(devinfo);
6159 	HDA_BOOTHVERBOSE(
6160 		device_printf(dev, "Disabling "
6161 		    "crossassociatement connections...\n");
6162 	);
6163 	hdaa_audio_disable_crossas(devinfo);
6164 	HDA_BOOTHVERBOSE(
6165 		device_printf(dev, "Disabling useless...\n");
6166 	);
6167 	hdaa_audio_disable_useless(devinfo);
6168 	HDA_BOOTHVERBOSE(
6169 		device_printf(dev, "Binding associations to channels...\n");
6170 	);
6171 	hdaa_audio_bind_as(devinfo);
6172 	HDA_BOOTHVERBOSE(
6173 		device_printf(dev, "Assigning names to signal sources...\n");
6174 	);
6175 	hdaa_audio_assign_names(devinfo);
6176 	HDA_BOOTHVERBOSE(
6177 		device_printf(dev, "Preparing PCM devices...\n");
6178 	);
6179 	hdaa_prepare_pcms(devinfo);
6180 	HDA_BOOTHVERBOSE(
6181 		device_printf(dev, "Assigning mixers to the tree...\n");
6182 	);
6183 	hdaa_audio_assign_mixers(devinfo);
6184 	HDA_BOOTHVERBOSE(
6185 		device_printf(dev, "Preparing pin controls...\n");
6186 	);
6187 	hdaa_audio_prepare_pin_ctrl(devinfo);
6188 	HDA_BOOTHVERBOSE(
6189 		device_printf(dev, "AFG commit...\n");
6190 	);
6191 	hdaa_audio_commit(devinfo);
6192 	HDA_BOOTHVERBOSE(
6193 		device_printf(dev, "Applying direct built-in patches...\n");
6194 	);
6195 	hdaa_patch_direct(devinfo);
6196 	HDA_BOOTHVERBOSE(
6197 		device_printf(dev, "Pin sense init...\n");
6198 	);
6199 	hdaa_sense_init(devinfo);
6200 	HDA_BOOTHVERBOSE(
6201 		device_printf(dev, "Creating PCM devices...\n");
6202 	);
6203 	hdaa_create_pcms(devinfo);
6204 
6205 	HDA_BOOTVERBOSE(
6206 		if (devinfo->quirks != 0) {
6207 			device_printf(dev, "FG config/quirks:");
6208 			for (i = 0; i < nitems(hdaa_quirks_tab); i++) {
6209 				if ((devinfo->quirks &
6210 				    hdaa_quirks_tab[i].value) ==
6211 				    hdaa_quirks_tab[i].value)
6212 					printf(" %s", hdaa_quirks_tab[i].key);
6213 			}
6214 			printf("\n");
6215 		}
6216 	);
6217 
6218 	HDA_BOOTHVERBOSE(
6219 		device_printf(dev, "\n");
6220 		device_printf(dev, "+-----------+\n");
6221 		device_printf(dev, "| HDA NODES |\n");
6222 		device_printf(dev, "+-----------+\n");
6223 		hdaa_dump_nodes(devinfo);
6224 
6225 		device_printf(dev, "\n");
6226 		device_printf(dev, "+----------------+\n");
6227 		device_printf(dev, "| HDA AMPLIFIERS |\n");
6228 		device_printf(dev, "+----------------+\n");
6229 		device_printf(dev, "\n");
6230 		i = 0;
6231 		while ((ctl = hdaa_audio_ctl_each(devinfo, &i)) != NULL) {
6232 			device_printf(dev, "%3d: nid %3d %s (%s) index %d", i,
6233 			    (ctl->widget != NULL) ? ctl->widget->nid : -1,
6234 			    (ctl->ndir == HDAA_CTL_IN)?"in ":"out",
6235 			    (ctl->dir == HDAA_CTL_IN)?"in ":"out",
6236 			    ctl->index);
6237 			if (ctl->childwidget != NULL)
6238 				printf(" cnid %3d", ctl->childwidget->nid);
6239 			else
6240 				printf("         ");
6241 			printf(" ossmask=0x%08x\n",
6242 			    ctl->ossmask);
6243 			device_printf(dev,
6244 			    "       mute: %d step: %3d size: %3d off: %3d%s\n",
6245 			    ctl->mute, ctl->step, ctl->size, ctl->offset,
6246 			    (ctl->enable == 0) ? " [DISABLED]" :
6247 			    ((ctl->ossmask == 0) ? " [UNUSED]" : ""));
6248 		}
6249 		device_printf(dev, "\n");
6250 	);
6251 }
6252 
6253 static void
hdaa_unconfigure(device_t dev)6254 hdaa_unconfigure(device_t dev)
6255 {
6256 	struct hdaa_devinfo *devinfo = device_get_softc(dev);
6257 	struct hdaa_widget *w;
6258 	int i, j;
6259 
6260 	HDA_BOOTHVERBOSE(
6261 		device_printf(dev, "Pin sense deinit...\n");
6262 	);
6263 	hdaa_sense_deinit(devinfo);
6264 	free(devinfo->ctl, M_HDAA);
6265 	devinfo->ctl = NULL;
6266 	devinfo->ctlcnt = 0;
6267 	free(devinfo->as, M_HDAA);
6268 	devinfo->as = NULL;
6269 	devinfo->ascnt = 0;
6270 	free(devinfo->devs, M_HDAA);
6271 	devinfo->devs = NULL;
6272 	devinfo->num_devs = 0;
6273 	free(devinfo->chans, M_HDAA);
6274 	devinfo->chans = NULL;
6275 	devinfo->num_chans = 0;
6276 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
6277 		w = hdaa_widget_get(devinfo, i);
6278 		if (w == NULL)
6279 			continue;
6280 		w->enable = 1;
6281 		w->selconn = -1;
6282 		w->pflags = 0;
6283 		w->bindas = -1;
6284 		w->bindseqmask = 0;
6285 		w->ossdev = -1;
6286 		w->ossmask = 0;
6287 		for (j = 0; j < w->nconns; j++)
6288 			w->connsenable[j] = 1;
6289 		if (w->type == HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
6290 			w->wclass.pin.config = w->wclass.pin.newconf;
6291 		if (w->eld != NULL) {
6292 			w->eld_len = 0;
6293 			free(w->eld, M_HDAA);
6294 			w->eld = NULL;
6295 		}
6296 	}
6297 }
6298 
6299 static int
hdaa_sysctl_gpi_state(SYSCTL_HANDLER_ARGS)6300 hdaa_sysctl_gpi_state(SYSCTL_HANDLER_ARGS)
6301 {
6302 	struct hdaa_devinfo *devinfo = oidp->oid_arg1;
6303 	device_t dev = devinfo->dev;
6304 	char buf[256];
6305 	int n = 0, i, numgpi;
6306 	uint32_t data = 0;
6307 
6308 	buf[0] = 0;
6309 	hdaa_lock(devinfo);
6310 	numgpi = HDA_PARAM_GPIO_COUNT_NUM_GPI(devinfo->gpio_cap);
6311 	if (numgpi > 0) {
6312 		data = hda_command(dev,
6313 		    HDA_CMD_GET_GPI_DATA(0, devinfo->nid));
6314 	}
6315 	hdaa_unlock(devinfo);
6316 	for (i = 0; i < numgpi; i++) {
6317 		n += snprintf(buf + n, sizeof(buf) - n, "%s%d=%d",
6318 		    n != 0 ? " " : "", i, ((data >> i) & 1));
6319 	}
6320 	return (sysctl_handle_string(oidp, buf, sizeof(buf), req));
6321 }
6322 
6323 static int
hdaa_sysctl_gpio_state(SYSCTL_HANDLER_ARGS)6324 hdaa_sysctl_gpio_state(SYSCTL_HANDLER_ARGS)
6325 {
6326 	struct hdaa_devinfo *devinfo = oidp->oid_arg1;
6327 	device_t dev = devinfo->dev;
6328 	char buf[256];
6329 	int n = 0, i, numgpio;
6330 	uint32_t data = 0, enable = 0, dir = 0;
6331 
6332 	buf[0] = 0;
6333 	hdaa_lock(devinfo);
6334 	numgpio = HDA_PARAM_GPIO_COUNT_NUM_GPIO(devinfo->gpio_cap);
6335 	if (numgpio > 0) {
6336 		data = hda_command(dev,
6337 		    HDA_CMD_GET_GPIO_DATA(0, devinfo->nid));
6338 		enable = hda_command(dev,
6339 		    HDA_CMD_GET_GPIO_ENABLE_MASK(0, devinfo->nid));
6340 		dir = hda_command(dev,
6341 		    HDA_CMD_GET_GPIO_DIRECTION(0, devinfo->nid));
6342 	}
6343 	hdaa_unlock(devinfo);
6344 	for (i = 0; i < numgpio; i++) {
6345 		n += snprintf(buf + n, sizeof(buf) - n, "%s%d=",
6346 		    n != 0 ? " " : "", i);
6347 		if ((enable & (1 << i)) == 0) {
6348 			n += snprintf(buf + n, sizeof(buf) - n, "disabled");
6349 			continue;
6350 		}
6351 		n += snprintf(buf + n, sizeof(buf) - n, "%sput(%d)",
6352 		    ((dir >> i) & 1) ? "out" : "in", ((data >> i) & 1));
6353 	}
6354 	return (sysctl_handle_string(oidp, buf, sizeof(buf), req));
6355 }
6356 
6357 static int
hdaa_sysctl_gpio_config(SYSCTL_HANDLER_ARGS)6358 hdaa_sysctl_gpio_config(SYSCTL_HANDLER_ARGS)
6359 {
6360 	struct hdaa_devinfo *devinfo = oidp->oid_arg1;
6361 	char buf[256];
6362 	int error, n = 0, i, numgpio;
6363 	uint32_t gpio, x;
6364 
6365 	gpio = devinfo->newgpio;
6366 	numgpio = HDA_PARAM_GPIO_COUNT_NUM_GPIO(devinfo->gpio_cap);
6367 	buf[0] = 0;
6368 	for (i = 0; i < numgpio; i++) {
6369 		x = (gpio & HDAA_GPIO_MASK(i)) >> HDAA_GPIO_SHIFT(i);
6370 		n += snprintf(buf + n, sizeof(buf) - n, "%s%d=%s",
6371 		    n != 0 ? " " : "", i, HDA_GPIO_ACTIONS[x]);
6372 	}
6373 	error = sysctl_handle_string(oidp, buf, sizeof(buf), req);
6374 	if (error != 0 || req->newptr == NULL)
6375 		return (error);
6376 	if (strncmp(buf, "0x", 2) == 0)
6377 		gpio = strtol(buf + 2, NULL, 16);
6378 	else
6379 		gpio = hdaa_gpio_patch(gpio, buf);
6380 	hdaa_lock(devinfo);
6381 	devinfo->newgpio = devinfo->gpio = gpio;
6382 	hdaa_gpio_commit(devinfo);
6383 	hdaa_unlock(devinfo);
6384 	return (0);
6385 }
6386 
6387 static int
hdaa_sysctl_gpo_state(SYSCTL_HANDLER_ARGS)6388 hdaa_sysctl_gpo_state(SYSCTL_HANDLER_ARGS)
6389 {
6390 	struct hdaa_devinfo *devinfo = oidp->oid_arg1;
6391 	device_t dev = devinfo->dev;
6392 	char buf[256];
6393 	int n = 0, i, numgpo;
6394 	uint32_t data = 0;
6395 
6396 	buf[0] = 0;
6397 	hdaa_lock(devinfo);
6398 	numgpo = HDA_PARAM_GPIO_COUNT_NUM_GPO(devinfo->gpio_cap);
6399 	if (numgpo > 0) {
6400 		data = hda_command(dev,
6401 		    HDA_CMD_GET_GPO_DATA(0, devinfo->nid));
6402 	}
6403 	hdaa_unlock(devinfo);
6404 	for (i = 0; i < numgpo; i++) {
6405 		n += snprintf(buf + n, sizeof(buf) - n, "%s%d=%d",
6406 		    n != 0 ? " " : "", i, ((data >> i) & 1));
6407 	}
6408 	return (sysctl_handle_string(oidp, buf, sizeof(buf), req));
6409 }
6410 
6411 static int
hdaa_sysctl_gpo_config(SYSCTL_HANDLER_ARGS)6412 hdaa_sysctl_gpo_config(SYSCTL_HANDLER_ARGS)
6413 {
6414 	struct hdaa_devinfo *devinfo = oidp->oid_arg1;
6415 	char buf[256];
6416 	int error, n = 0, i, numgpo;
6417 	uint32_t gpo, x;
6418 
6419 	gpo = devinfo->newgpo;
6420 	numgpo = HDA_PARAM_GPIO_COUNT_NUM_GPO(devinfo->gpio_cap);
6421 	buf[0] = 0;
6422 	for (i = 0; i < numgpo; i++) {
6423 		x = (gpo & HDAA_GPIO_MASK(i)) >> HDAA_GPIO_SHIFT(i);
6424 		n += snprintf(buf + n, sizeof(buf) - n, "%s%d=%s",
6425 		    n != 0 ? " " : "", i, HDA_GPIO_ACTIONS[x]);
6426 	}
6427 	error = sysctl_handle_string(oidp, buf, sizeof(buf), req);
6428 	if (error != 0 || req->newptr == NULL)
6429 		return (error);
6430 	if (strncmp(buf, "0x", 2) == 0)
6431 		gpo = strtol(buf + 2, NULL, 16);
6432 	else
6433 		gpo = hdaa_gpio_patch(gpo, buf);
6434 	hdaa_lock(devinfo);
6435 	devinfo->newgpo = devinfo->gpo = gpo;
6436 	hdaa_gpo_commit(devinfo);
6437 	hdaa_unlock(devinfo);
6438 	return (0);
6439 }
6440 
6441 static int
hdaa_sysctl_reconfig(SYSCTL_HANDLER_ARGS)6442 hdaa_sysctl_reconfig(SYSCTL_HANDLER_ARGS)
6443 {
6444 	device_t dev;
6445 	struct hdaa_devinfo *devinfo;
6446 	int error, val;
6447 
6448 	dev = oidp->oid_arg1;
6449 	devinfo = device_get_softc(dev);
6450 	if (devinfo == NULL)
6451 		return (EINVAL);
6452 	val = 0;
6453 	error = sysctl_handle_int(oidp, &val, 0, req);
6454 	if (error != 0 || req->newptr == NULL || val == 0)
6455 		return (error);
6456 
6457 	HDA_BOOTHVERBOSE(
6458 		device_printf(dev, "Reconfiguration...\n");
6459 	);
6460 
6461 	bus_topo_lock();
6462 
6463 	if ((error = device_delete_children(dev)) != 0) {
6464 		bus_topo_unlock();
6465 		return (error);
6466 	}
6467 	hdaa_lock(devinfo);
6468 	hdaa_unconfigure(dev);
6469 	hdaa_configure(dev);
6470 	hdaa_unlock(devinfo);
6471 	bus_generic_attach(dev);
6472 	HDA_BOOTHVERBOSE(
6473 		device_printf(dev, "Reconfiguration done\n");
6474 	);
6475 
6476 	bus_topo_unlock();
6477 
6478 	return (0);
6479 }
6480 
6481 static int
hdaa_suspend(device_t dev)6482 hdaa_suspend(device_t dev)
6483 {
6484 	struct hdaa_devinfo *devinfo = device_get_softc(dev);
6485 	int i;
6486 
6487 	HDA_BOOTHVERBOSE(
6488 		device_printf(dev, "Suspend...\n");
6489 	);
6490 	hdaa_lock(devinfo);
6491 	HDA_BOOTHVERBOSE(
6492 		device_printf(dev, "Stop streams...\n");
6493 	);
6494 	for (i = 0; i < devinfo->num_chans; i++) {
6495 		if (devinfo->chans[i].flags & HDAA_CHN_RUNNING) {
6496 			devinfo->chans[i].flags |= HDAA_CHN_SUSPEND;
6497 			hdaa_channel_stop(&devinfo->chans[i]);
6498 		}
6499 	}
6500 	HDA_BOOTHVERBOSE(
6501 		device_printf(dev, "Power down FG"
6502 		    " nid=%d to the D3 state...\n",
6503 		    devinfo->nid);
6504 	);
6505 	hda_command(devinfo->dev,
6506 	    HDA_CMD_SET_POWER_STATE(0,
6507 	    devinfo->nid, HDA_CMD_POWER_STATE_D3));
6508 	callout_stop(&devinfo->poll_jack);
6509 	hdaa_unlock(devinfo);
6510 	callout_drain(&devinfo->poll_jack);
6511 	HDA_BOOTHVERBOSE(
6512 		device_printf(dev, "Suspend done\n");
6513 	);
6514 	return (0);
6515 }
6516 
6517 static int
hdaa_resume(device_t dev)6518 hdaa_resume(device_t dev)
6519 {
6520 	struct hdaa_devinfo *devinfo = device_get_softc(dev);
6521 	int i;
6522 
6523 	HDA_BOOTHVERBOSE(
6524 		device_printf(dev, "Resume...\n");
6525 	);
6526 	hdaa_lock(devinfo);
6527 	HDA_BOOTHVERBOSE(
6528 		device_printf(dev, "Power up audio FG nid=%d...\n",
6529 		    devinfo->nid);
6530 	);
6531 	hdaa_powerup(devinfo);
6532 	HDA_BOOTHVERBOSE(
6533 		device_printf(dev, "AFG commit...\n");
6534 	);
6535 	hdaa_audio_commit(devinfo);
6536 	HDA_BOOTHVERBOSE(
6537 		device_printf(dev, "Applying direct built-in patches...\n");
6538 	);
6539 	hdaa_patch_direct(devinfo);
6540 	HDA_BOOTHVERBOSE(
6541 		device_printf(dev, "Pin sense init...\n");
6542 	);
6543 	hdaa_sense_init(devinfo);
6544 
6545 	hdaa_unlock(devinfo);
6546 	for (i = 0; i < devinfo->num_devs; i++) {
6547 		struct hdaa_pcm_devinfo *pdevinfo = &devinfo->devs[i];
6548 		HDA_BOOTHVERBOSE(
6549 			device_printf(pdevinfo->dev,
6550 			    "OSS mixer reinitialization...\n");
6551 		);
6552 		if (mixer_reinit(pdevinfo->dev) == -1)
6553 			device_printf(pdevinfo->dev,
6554 			    "unable to reinitialize the mixer\n");
6555 	}
6556 	hdaa_lock(devinfo);
6557 	HDA_BOOTHVERBOSE(
6558 		device_printf(dev, "Start streams...\n");
6559 	);
6560 	for (i = 0; i < devinfo->num_chans; i++) {
6561 		if (devinfo->chans[i].flags & HDAA_CHN_SUSPEND) {
6562 			devinfo->chans[i].flags &= ~HDAA_CHN_SUSPEND;
6563 			hdaa_channel_start(&devinfo->chans[i]);
6564 		}
6565 	}
6566 	hdaa_unlock(devinfo);
6567 	HDA_BOOTHVERBOSE(
6568 		device_printf(dev, "Resume done\n");
6569 	);
6570 	return (0);
6571 }
6572 
6573 static int
hdaa_probe(device_t dev)6574 hdaa_probe(device_t dev)
6575 {
6576 	const char *pdesc;
6577 
6578 	if (hda_get_node_type(dev) != HDA_PARAM_FCT_GRP_TYPE_NODE_TYPE_AUDIO)
6579 		return (ENXIO);
6580 	pdesc = device_get_desc(device_get_parent(dev));
6581 	device_set_descf(dev, "%.*s Audio Function Group",
6582 	    (int)(strlen(pdesc) - 10), pdesc);
6583 	return (BUS_PROBE_DEFAULT);
6584 }
6585 
6586 static int
hdaa_attach(device_t dev)6587 hdaa_attach(device_t dev)
6588 {
6589 	struct hdaa_devinfo *devinfo = device_get_softc(dev);
6590 	uint32_t res;
6591 	nid_t nid = hda_get_node_id(dev);
6592 
6593 	devinfo->dev = dev;
6594 	devinfo->lock = HDAC_GET_MTX(device_get_parent(dev), dev);
6595 	devinfo->nid = nid;
6596 	devinfo->newquirks = -1;
6597 	devinfo->newgpio = -1;
6598 	devinfo->newgpo = -1;
6599 	callout_init(&devinfo->poll_jack, 1);
6600 	devinfo->poll_ival = hz;
6601 
6602 	hdaa_lock(devinfo);
6603 	res = hda_command(dev,
6604 	    HDA_CMD_GET_PARAMETER(0 , nid, HDA_PARAM_SUB_NODE_COUNT));
6605 	hdaa_unlock(devinfo);
6606 
6607 	devinfo->nodecnt = HDA_PARAM_SUB_NODE_COUNT_TOTAL(res);
6608 	devinfo->startnode = HDA_PARAM_SUB_NODE_COUNT_START(res);
6609 	devinfo->endnode = devinfo->startnode + devinfo->nodecnt;
6610 
6611 	HDA_BOOTVERBOSE(
6612 		device_printf(dev, "Subsystem ID: 0x%08x\n",
6613 		    hda_get_subsystem_id(dev));
6614 	);
6615 	HDA_BOOTHVERBOSE(
6616 		device_printf(dev,
6617 		    "Audio Function Group at nid=%d: %d subnodes %d-%d\n",
6618 		    nid, devinfo->nodecnt,
6619 		    devinfo->startnode, devinfo->endnode - 1);
6620 	);
6621 
6622 	if (devinfo->nodecnt > 0)
6623 		devinfo->widget = malloc(sizeof(*(devinfo->widget)) *
6624 		    devinfo->nodecnt, M_HDAA, M_WAITOK | M_ZERO);
6625 	else
6626 		devinfo->widget = NULL;
6627 
6628 	hdaa_lock(devinfo);
6629 	HDA_BOOTHVERBOSE(
6630 		device_printf(dev, "Powering up...\n");
6631 	);
6632 	hdaa_powerup(devinfo);
6633 	HDA_BOOTHVERBOSE(
6634 		device_printf(dev, "Parsing audio FG...\n");
6635 	);
6636 	hdaa_audio_parse(devinfo);
6637 	HDA_BOOTVERBOSE(
6638 		device_printf(dev, "Original pins configuration:\n");
6639 		hdaa_dump_pin_configs(devinfo);
6640 	);
6641 	hdaa_configure(dev);
6642 	hdaa_unlock(devinfo);
6643 
6644 	SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
6645 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO,
6646 	    "config", CTLTYPE_STRING | CTLFLAG_RW | CTLFLAG_MPSAFE,
6647 	    &devinfo->newquirks, 0, hdaa_sysctl_quirks, "A",
6648 	    "Configuration options");
6649 	SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
6650 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO,
6651 	    "gpi_state", CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE,
6652 	    devinfo, 0, hdaa_sysctl_gpi_state, "A", "GPI state");
6653 	SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
6654 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO,
6655 	    "gpio_state", CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE,
6656 	    devinfo, 0, hdaa_sysctl_gpio_state, "A", "GPIO state");
6657 	SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
6658 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO,
6659 	    "gpio_config", CTLTYPE_STRING | CTLFLAG_RW | CTLFLAG_MPSAFE,
6660 	    devinfo, 0, hdaa_sysctl_gpio_config, "A", "GPIO configuration");
6661 	SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
6662 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO,
6663 	    "gpo_state", CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE,
6664 	    devinfo, 0, hdaa_sysctl_gpo_state, "A", "GPO state");
6665 	SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
6666 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO,
6667 	    "gpo_config", CTLTYPE_STRING | CTLFLAG_RW | CTLFLAG_MPSAFE,
6668 	    devinfo, 0, hdaa_sysctl_gpo_config, "A", "GPO configuration");
6669 	SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
6670 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO,
6671 	    "reconfig", CTLTYPE_INT | CTLFLAG_RW,
6672 	    dev, 0, hdaa_sysctl_reconfig, "I", "Reprocess configuration");
6673 	SYSCTL_ADD_INT(device_get_sysctl_ctx(dev),
6674 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO,
6675 	    "init_clear", CTLFLAG_RW,
6676 	    &devinfo->init_clear, 1,"Clear initial pin widget configuration");
6677 	bus_generic_attach(dev);
6678 	return (0);
6679 }
6680 
6681 static int
hdaa_detach(device_t dev)6682 hdaa_detach(device_t dev)
6683 {
6684 	struct hdaa_devinfo *devinfo = device_get_softc(dev);
6685 	int error;
6686 
6687 	if ((error = device_delete_children(dev)) != 0)
6688 		return (error);
6689 
6690 	hdaa_lock(devinfo);
6691 	hdaa_unconfigure(dev);
6692 	devinfo->poll_ival = 0;
6693 	callout_stop(&devinfo->poll_jack);
6694 	hdaa_unlock(devinfo);
6695 	callout_drain(&devinfo->poll_jack);
6696 
6697 	free(devinfo->widget, M_HDAA);
6698 	return (0);
6699 }
6700 
6701 static int
hdaa_print_child(device_t dev,device_t child)6702 hdaa_print_child(device_t dev, device_t child)
6703 {
6704 	struct hdaa_devinfo *devinfo = device_get_softc(dev);
6705 	struct hdaa_pcm_devinfo *pdevinfo =
6706 	    (struct hdaa_pcm_devinfo *)device_get_ivars(child);
6707 	struct hdaa_audio_as *as;
6708 	int retval, first = 1, i;
6709 
6710 	retval = bus_print_child_header(dev, child);
6711 	retval += printf(" at nid ");
6712 	if (pdevinfo->playas >= 0) {
6713 		as = &devinfo->as[pdevinfo->playas];
6714 		for (i = 0; i < 16; i++) {
6715 			if (as->pins[i] <= 0)
6716 				continue;
6717 			retval += printf("%s%d", first ? "" : ",", as->pins[i]);
6718 			first = 0;
6719 		}
6720 	}
6721 	if (pdevinfo->recas >= 0) {
6722 		if (pdevinfo->playas >= 0) {
6723 			retval += printf(" and ");
6724 			first = 1;
6725 		}
6726 		as = &devinfo->as[pdevinfo->recas];
6727 		for (i = 0; i < 16; i++) {
6728 			if (as->pins[i] <= 0)
6729 				continue;
6730 			retval += printf("%s%d", first ? "" : ",", as->pins[i]);
6731 			first = 0;
6732 		}
6733 	}
6734 	retval += bus_print_child_footer(dev, child);
6735 
6736 	return (retval);
6737 }
6738 
6739 static int
hdaa_child_location(device_t dev,device_t child,struct sbuf * sb)6740 hdaa_child_location(device_t dev, device_t child, struct sbuf *sb)
6741 {
6742 	struct hdaa_devinfo *devinfo = device_get_softc(dev);
6743 	struct hdaa_pcm_devinfo *pdevinfo =
6744 	    (struct hdaa_pcm_devinfo *)device_get_ivars(child);
6745 	struct hdaa_audio_as *as;
6746 	int first = 1, i;
6747 
6748 	sbuf_printf(sb, "nid=");
6749 	if (pdevinfo->playas >= 0) {
6750 		as = &devinfo->as[pdevinfo->playas];
6751 		for (i = 0; i < 16; i++) {
6752 			if (as->pins[i] <= 0)
6753 				continue;
6754 			sbuf_printf(sb, "%s%d", first ? "" : ",", as->pins[i]);
6755 			first = 0;
6756 		}
6757 	}
6758 	if (pdevinfo->recas >= 0) {
6759 		as = &devinfo->as[pdevinfo->recas];
6760 		for (i = 0; i < 16; i++) {
6761 			if (as->pins[i] <= 0)
6762 				continue;
6763 			sbuf_printf(sb, "%s%d", first ? "" : ",", as->pins[i]);
6764 			first = 0;
6765 		}
6766 	}
6767 	return (0);
6768 }
6769 
6770 static void
hdaa_stream_intr(device_t dev,int dir,int stream)6771 hdaa_stream_intr(device_t dev, int dir, int stream)
6772 {
6773 	struct hdaa_devinfo *devinfo = device_get_softc(dev);
6774 	struct hdaa_chan *ch;
6775 	int i;
6776 
6777 	for (i = 0; i < devinfo->num_chans; i++) {
6778 		ch = &devinfo->chans[i];
6779 		if (!(ch->flags & HDAA_CHN_RUNNING))
6780 			continue;
6781 		if (ch->dir == ((dir == 1) ? PCMDIR_PLAY : PCMDIR_REC) &&
6782 		    ch->sid == stream) {
6783 			hdaa_unlock(devinfo);
6784 			chn_intr(ch->c);
6785 			hdaa_lock(devinfo);
6786 		}
6787 	}
6788 }
6789 
6790 static void
hdaa_unsol_intr(device_t dev,uint32_t resp)6791 hdaa_unsol_intr(device_t dev, uint32_t resp)
6792 {
6793 	struct hdaa_devinfo *devinfo = device_get_softc(dev);
6794 	struct hdaa_widget *w;
6795 	int i, tag, flags;
6796 
6797 	HDA_BOOTHVERBOSE(
6798 		device_printf(dev, "Unsolicited response %08x\n", resp);
6799 	);
6800 	tag = resp >> 26;
6801 	for (i = devinfo->startnode; i < devinfo->endnode; i++) {
6802 		w = hdaa_widget_get(devinfo, i);
6803 		if (w == NULL || w->enable == 0 || w->type !=
6804 		    HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
6805 			continue;
6806 		if (w->unsol != tag)
6807 			continue;
6808 		if (HDA_PARAM_PIN_CAP_DP(w->wclass.pin.cap) ||
6809 		    HDA_PARAM_PIN_CAP_HDMI(w->wclass.pin.cap))
6810 			flags = resp & 0x03;
6811 		else
6812 			flags = 0x01;
6813 		if (flags & 0x01)
6814 			hdaa_presence_handler(w);
6815 		if (flags & 0x02)
6816 			hdaa_eld_handler(w);
6817 	}
6818 }
6819 
6820 static device_method_t hdaa_methods[] = {
6821 	/* device interface */
6822 	DEVMETHOD(device_probe,		hdaa_probe),
6823 	DEVMETHOD(device_attach,	hdaa_attach),
6824 	DEVMETHOD(device_detach,	hdaa_detach),
6825 	DEVMETHOD(device_suspend,	hdaa_suspend),
6826 	DEVMETHOD(device_resume,	hdaa_resume),
6827 	/* Bus interface */
6828 	DEVMETHOD(bus_print_child,	hdaa_print_child),
6829 	DEVMETHOD(bus_child_location,	hdaa_child_location),
6830 	DEVMETHOD(hdac_stream_intr,	hdaa_stream_intr),
6831 	DEVMETHOD(hdac_unsol_intr,	hdaa_unsol_intr),
6832 	DEVMETHOD(hdac_pindump,		hdaa_pindump),
6833 	DEVMETHOD_END
6834 };
6835 
6836 static driver_t hdaa_driver = {
6837 	"hdaa",
6838 	hdaa_methods,
6839 	sizeof(struct hdaa_devinfo),
6840 };
6841 
6842 DRIVER_MODULE(snd_hda, hdacc, hdaa_driver, NULL, NULL);
6843 
6844 static void
hdaa_chan_formula(struct hdaa_devinfo * devinfo,int asid,char * buf,int buflen)6845 hdaa_chan_formula(struct hdaa_devinfo *devinfo, int asid,
6846     char *buf, int buflen)
6847 {
6848 	struct hdaa_audio_as *as;
6849 	int c;
6850 
6851 	as = &devinfo->as[asid];
6852 	c = devinfo->chans[as->chans[0]].channels;
6853 	if (c == 1)
6854 		snprintf(buf, buflen, "mono");
6855 	else if (c == 2) {
6856 		if (as->hpredir < 0)
6857 			buf[0] = 0;
6858 		else
6859 			snprintf(buf, buflen, "2.0");
6860 	} else if (as->pinset == 0x0003)
6861 		snprintf(buf, buflen, "3.1");
6862 	else if (as->pinset == 0x0005 || as->pinset == 0x0011)
6863 		snprintf(buf, buflen, "4.0");
6864 	else if (as->pinset == 0x0007 || as->pinset == 0x0013)
6865 		snprintf(buf, buflen, "5.1");
6866 	else if (as->pinset == 0x0017)
6867 		snprintf(buf, buflen, "7.1");
6868 	else
6869 		snprintf(buf, buflen, "%dch", c);
6870 	if (as->hpredir >= 0)
6871 		strlcat(buf, "+HP", buflen);
6872 }
6873 
6874 static int
hdaa_chan_type(struct hdaa_devinfo * devinfo,int asid)6875 hdaa_chan_type(struct hdaa_devinfo *devinfo, int asid)
6876 {
6877 	struct hdaa_audio_as *as;
6878 	struct hdaa_widget *w;
6879 	int i, t = -1, t1;
6880 
6881 	as = &devinfo->as[asid];
6882 	for (i = 0; i < 16; i++) {
6883 		w = hdaa_widget_get(devinfo, as->pins[i]);
6884 		if (w == NULL || w->enable == 0 || w->type !=
6885 		    HDA_PARAM_AUDIO_WIDGET_CAP_TYPE_PIN_COMPLEX)
6886 			continue;
6887 		t1 = HDA_CONFIG_DEFAULTCONF_DEVICE(w->wclass.pin.config);
6888 		if (t == -1)
6889 			t = t1;
6890 		else if (t != t1) {
6891 			t = -2;
6892 			break;
6893 		}
6894 	}
6895 	return (t);
6896 }
6897 
6898 static int
hdaa_sysctl_32bit(SYSCTL_HANDLER_ARGS)6899 hdaa_sysctl_32bit(SYSCTL_HANDLER_ARGS)
6900 {
6901 	struct hdaa_audio_as *as = (struct hdaa_audio_as *)oidp->oid_arg1;
6902 	struct hdaa_pcm_devinfo *pdevinfo = as->pdevinfo;
6903 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
6904 	struct hdaa_chan *ch;
6905 	int error, val, i;
6906 	uint32_t pcmcap;
6907 
6908 	ch = &devinfo->chans[as->chans[0]];
6909 	val = (ch->bit32 == 4) ? 32 : ((ch->bit32 == 3) ? 24 :
6910 	    ((ch->bit32 == 2) ? 20 : 0));
6911 	error = sysctl_handle_int(oidp, &val, 0, req);
6912 	if (error != 0 || req->newptr == NULL)
6913 		return (error);
6914 	pcmcap = ch->supp_pcm_size_rate;
6915 	if (val == 32 && HDA_PARAM_SUPP_PCM_SIZE_RATE_32BIT(pcmcap))
6916 		ch->bit32 = 4;
6917 	else if (val == 24 && HDA_PARAM_SUPP_PCM_SIZE_RATE_24BIT(pcmcap))
6918 		ch->bit32 = 3;
6919 	else if (val == 20 && HDA_PARAM_SUPP_PCM_SIZE_RATE_20BIT(pcmcap))
6920 		ch->bit32 = 2;
6921 	else
6922 		return (EINVAL);
6923 	for (i = 1; i < as->num_chans; i++)
6924 		devinfo->chans[as->chans[i]].bit32 = ch->bit32;
6925 	return (0);
6926 }
6927 
6928 static int
hdaa_pcm_probe(device_t dev)6929 hdaa_pcm_probe(device_t dev)
6930 {
6931 	struct hdaa_pcm_devinfo *pdevinfo =
6932 	    (struct hdaa_pcm_devinfo *)device_get_ivars(dev);
6933 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
6934 	const char *pdesc;
6935 	char chans1[8], chans2[8];
6936 	int loc1, loc2, t1, t2;
6937 
6938 	if (pdevinfo->playas >= 0)
6939 		loc1 = devinfo->as[pdevinfo->playas].location;
6940 	else
6941 		loc1 = devinfo->as[pdevinfo->recas].location;
6942 	if (pdevinfo->recas >= 0)
6943 		loc2 = devinfo->as[pdevinfo->recas].location;
6944 	else
6945 		loc2 = loc1;
6946 	if (loc1 != loc2)
6947 		loc1 = -2;
6948 	if (loc1 >= 0 && HDA_LOCS[loc1][0] == '0')
6949 		loc1 = -2;
6950 	chans1[0] = 0;
6951 	chans2[0] = 0;
6952 	t1 = t2 = -1;
6953 	if (pdevinfo->playas >= 0) {
6954 		hdaa_chan_formula(devinfo, pdevinfo->playas,
6955 		    chans1, sizeof(chans1));
6956 		t1 = hdaa_chan_type(devinfo, pdevinfo->playas);
6957 	}
6958 	if (pdevinfo->recas >= 0) {
6959 		hdaa_chan_formula(devinfo, pdevinfo->recas,
6960 		    chans2, sizeof(chans2));
6961 		t2 = hdaa_chan_type(devinfo, pdevinfo->recas);
6962 	}
6963 	if (chans1[0] != 0 || chans2[0] != 0) {
6964 		if (chans1[0] == 0 && pdevinfo->playas >= 0)
6965 			snprintf(chans1, sizeof(chans1), "2.0");
6966 		else if (chans2[0] == 0 && pdevinfo->recas >= 0)
6967 			snprintf(chans2, sizeof(chans2), "2.0");
6968 		if (strcmp(chans1, chans2) == 0)
6969 			chans2[0] = 0;
6970 	}
6971 	if (t1 == -1)
6972 		t1 = t2;
6973 	else if (t2 == -1)
6974 		t2 = t1;
6975 	if (t1 != t2)
6976 		t1 = -2;
6977 	if (pdevinfo->digital)
6978 		t1 = -2;
6979 	pdesc = device_get_desc(device_get_parent(dev));
6980 	device_set_descf(dev, "%.*s (%s%s%s%s%s%s%s%s%s)",
6981 	    (int)(strlen(pdesc) - 21), pdesc,
6982 	    loc1 >= 0 ? HDA_LOCS[loc1] : "", loc1 >= 0 ? " " : "",
6983 	    (pdevinfo->digital == 0x7)?"HDMI/DP":
6984 	    ((pdevinfo->digital == 0x5)?"DisplayPort":
6985 	    ((pdevinfo->digital == 0x3)?"HDMI":
6986 	    ((pdevinfo->digital)?"Digital":"Analog"))),
6987 	    chans1[0] ? " " : "", chans1,
6988 	    chans2[0] ? "/" : "", chans2,
6989 	    t1 >= 0 ? " " : "", t1 >= 0 ? HDA_DEVS[t1] : "");
6990 	return (BUS_PROBE_SPECIFIC);
6991 }
6992 
6993 static int
hdaa_pcm_attach(device_t dev)6994 hdaa_pcm_attach(device_t dev)
6995 {
6996 	struct hdaa_pcm_devinfo *pdevinfo =
6997 	    (struct hdaa_pcm_devinfo *)device_get_ivars(dev);
6998 	struct hdaa_devinfo *devinfo = pdevinfo->devinfo;
6999 	struct hdaa_audio_as *as;
7000 	struct snddev_info *d;
7001 	char status[SND_STATUSLEN];
7002 	int i;
7003 
7004 	pdevinfo->chan_size = pcm_getbuffersize(dev,
7005 	    HDA_BUFSZ_MIN, HDA_BUFSZ_DEFAULT, HDA_BUFSZ_MAX);
7006 
7007 	HDA_BOOTVERBOSE(
7008 		hdaa_dump_dac(pdevinfo);
7009 		hdaa_dump_adc(pdevinfo);
7010 		hdaa_dump_mix(pdevinfo);
7011 		hdaa_dump_ctls(pdevinfo, "Master Volume", SOUND_MASK_VOLUME);
7012 		hdaa_dump_ctls(pdevinfo, "PCM Volume", SOUND_MASK_PCM);
7013 		hdaa_dump_ctls(pdevinfo, "CD Volume", SOUND_MASK_CD);
7014 		hdaa_dump_ctls(pdevinfo, "Microphone Volume", SOUND_MASK_MIC);
7015 		hdaa_dump_ctls(pdevinfo, "Microphone2 Volume", SOUND_MASK_MONITOR);
7016 		hdaa_dump_ctls(pdevinfo, "Line-in Volume", SOUND_MASK_LINE);
7017 		hdaa_dump_ctls(pdevinfo, "Speaker/Beep Volume", SOUND_MASK_SPEAKER);
7018 		hdaa_dump_ctls(pdevinfo, "Recording Level", SOUND_MASK_RECLEV);
7019 		hdaa_dump_ctls(pdevinfo, "Input Mix Level", SOUND_MASK_IMIX);
7020 		hdaa_dump_ctls(pdevinfo, "Input Monitoring Level", SOUND_MASK_IGAIN);
7021 		hdaa_dump_ctls(pdevinfo, NULL, 0);
7022 	);
7023 
7024 	if (resource_int_value(device_get_name(dev),
7025 	    device_get_unit(dev), "blocksize", &i) == 0 && i > 0) {
7026 		i &= HDA_BLK_ALIGN;
7027 		if (i < HDA_BLK_MIN)
7028 			i = HDA_BLK_MIN;
7029 		pdevinfo->chan_blkcnt = pdevinfo->chan_size / i;
7030 		i = 0;
7031 		while (pdevinfo->chan_blkcnt >> i)
7032 			i++;
7033 		pdevinfo->chan_blkcnt = 1 << (i - 1);
7034 		if (pdevinfo->chan_blkcnt < HDA_BDL_MIN)
7035 			pdevinfo->chan_blkcnt = HDA_BDL_MIN;
7036 		else if (pdevinfo->chan_blkcnt > HDA_BDL_MAX)
7037 			pdevinfo->chan_blkcnt = HDA_BDL_MAX;
7038 	} else
7039 		pdevinfo->chan_blkcnt = HDA_BDL_DEFAULT;
7040 
7041 	/*
7042 	 * We don't register interrupt handler with snd_setup_intr
7043 	 * in pcm device. Mark pcm device as MPSAFE manually.
7044 	 */
7045 	pcm_setflags(dev, pcm_getflags(dev) | SD_F_MPSAFE);
7046 
7047 	HDA_BOOTHVERBOSE(
7048 		device_printf(dev, "OSS mixer initialization...\n");
7049 	);
7050 	if (mixer_init(dev, &hdaa_audio_ctl_ossmixer_class, pdevinfo) != 0)
7051 		device_printf(dev, "Can't register mixer\n");
7052 
7053 	HDA_BOOTHVERBOSE(
7054 		device_printf(dev, "Registering PCM channels...\n");
7055 	);
7056 	pcm_init(dev, pdevinfo);
7057 
7058 	pdevinfo->registered++;
7059 
7060 	d = device_get_softc(dev);
7061 	if (pdevinfo->playas >= 0) {
7062 		as = &devinfo->as[pdevinfo->playas];
7063 		for (i = 0; i < as->num_chans; i++)
7064 			pcm_addchan(dev, PCMDIR_PLAY, &hdaa_channel_class,
7065 			    &devinfo->chans[as->chans[i]]);
7066 		SYSCTL_ADD_PROC(&d->play_sysctl_ctx,
7067 		    SYSCTL_CHILDREN(d->play_sysctl_tree), OID_AUTO,
7068 		    "32bit", CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE,
7069 		    as, sizeof(as), hdaa_sysctl_32bit, "I",
7070 		    "Resolution of 32bit samples (20/24/32bit)");
7071 	}
7072 	if (pdevinfo->recas >= 0) {
7073 		as = &devinfo->as[pdevinfo->recas];
7074 		for (i = 0; i < as->num_chans; i++)
7075 			pcm_addchan(dev, PCMDIR_REC, &hdaa_channel_class,
7076 			    &devinfo->chans[as->chans[i]]);
7077 		SYSCTL_ADD_PROC(&d->rec_sysctl_ctx,
7078 		    SYSCTL_CHILDREN(d->rec_sysctl_tree), OID_AUTO,
7079 		    "32bit", CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE,
7080 		    as, sizeof(as), hdaa_sysctl_32bit, "I",
7081 		    "Resolution of 32bit samples (20/24/32bit)");
7082 		pdevinfo->autorecsrc = 2;
7083 		resource_int_value(device_get_name(dev), device_get_unit(dev),
7084 		    "rec.autosrc", &pdevinfo->autorecsrc);
7085 		SYSCTL_ADD_INT(&d->rec_sysctl_ctx,
7086 		    SYSCTL_CHILDREN(d->rec_sysctl_tree), OID_AUTO,
7087 		    "autosrc", CTLFLAG_RW,
7088 		    &pdevinfo->autorecsrc, 0,
7089 		    "Automatic recording source selection");
7090 	}
7091 
7092 	if (pdevinfo->mixer != NULL) {
7093 		hdaa_audio_ctl_set_defaults(pdevinfo);
7094 		hdaa_lock(devinfo);
7095 		if (pdevinfo->playas >= 0) {
7096 			as = &devinfo->as[pdevinfo->playas];
7097 			hdaa_channels_handler(as);
7098 		}
7099 		if (pdevinfo->recas >= 0) {
7100 			as = &devinfo->as[pdevinfo->recas];
7101 			hdaa_autorecsrc_handler(as, NULL);
7102 			hdaa_channels_handler(as);
7103 		}
7104 		hdaa_unlock(devinfo);
7105 	}
7106 
7107 	snprintf(status, SND_STATUSLEN, "on %s",
7108 	    device_get_nameunit(device_get_parent(dev)));
7109 
7110 	return (pcm_register(dev, status));
7111 }
7112 
7113 static int
hdaa_pcm_detach(device_t dev)7114 hdaa_pcm_detach(device_t dev)
7115 {
7116 	struct hdaa_pcm_devinfo *pdevinfo =
7117 	    (struct hdaa_pcm_devinfo *)device_get_ivars(dev);
7118 	int err;
7119 
7120 	if (pdevinfo->registered > 0) {
7121 		err = pcm_unregister(dev);
7122 		if (err != 0)
7123 			return (err);
7124 	}
7125 
7126 	return (0);
7127 }
7128 
7129 static device_method_t hdaa_pcm_methods[] = {
7130 	/* device interface */
7131 	DEVMETHOD(device_probe,		hdaa_pcm_probe),
7132 	DEVMETHOD(device_attach,	hdaa_pcm_attach),
7133 	DEVMETHOD(device_detach,	hdaa_pcm_detach),
7134 	DEVMETHOD_END
7135 };
7136 
7137 static driver_t hdaa_pcm_driver = {
7138 	"pcm",
7139 	hdaa_pcm_methods,
7140 	PCM_SOFTC_SIZE,
7141 };
7142 
7143 DRIVER_MODULE(snd_hda_pcm, hdaa, hdaa_pcm_driver, NULL, NULL);
7144 MODULE_DEPEND(snd_hda, sound, SOUND_MINVER, SOUND_PREFVER, SOUND_MAXVER);
7145 MODULE_VERSION(snd_hda, 1);
7146