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