/* $OpenBSD: azalia.c,v 1.99 2008/12/31 11:23:55 jakemsr Exp $ */ /* $NetBSD: azalia.c,v 1.20 2006/05/07 08:31:44 kent Exp $ */ /*- * Copyright (c) 2005 The NetBSD Foundation, Inc. * All rights reserved. * * This code is derived from software contributed to The NetBSD Foundation * by TAMURA Kent * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * High Definition Audio Specification * ftp://download.intel.com/standards/hdaudio/pdf/HDAudio_03.pdf * * * TO DO: * - power hook * - multiple codecs (needed?) * - multiple streams (needed?) */ #include #include #include #include #include #include #include #include #include #include typedef struct audio_params audio_params_t; #ifndef BUS_DMA_NOCACHE #define BUS_DMA_NOCACHE 0 #endif struct audio_format { void *driver_data; int32_t mode; u_int encoding; u_int validbits; u_int precision; u_int channels; u_int channel_mask; #define AUFMT_UNKNOWN_POSITION 0U #define AUFMT_FRONT_LEFT 0x00001U /* USB audio compatible */ #define AUFMT_FRONT_RIGHT 0x00002U /* USB audio compatible */ #define AUFMT_FRONT_CENTER 0x00004U /* USB audio compatible */ #define AUFMT_LOW_FREQUENCY 0x00008U /* USB audio compatible */ #define AUFMT_BACK_LEFT 0x00010U /* USB audio compatible */ #define AUFMT_BACK_RIGHT 0x00020U /* USB audio compatible */ #define AUFMT_FRONT_LEFT_OF_CENTER 0x00040U /* USB audio compatible */ #define AUFMT_FRONT_RIGHT_OF_CENTER 0x00080U /* USB audio compatible */ #define AUFMT_BACK_CENTER 0x00100U /* USB audio compatible */ #define AUFMT_SIDE_LEFT 0x00200U /* USB audio compatible */ #define AUFMT_SIDE_RIGHT 0x00400U /* USB audio compatible */ #define AUFMT_TOP_CENTER 0x00800U /* USB audio compatible */ #define AUFMT_TOP_FRONT_LEFT 0x01000U #define AUFMT_TOP_FRONT_CENTER 0x02000U #define AUFMT_TOP_FRONT_RIGHT 0x04000U #define AUFMT_TOP_BACK_LEFT 0x08000U #define AUFMT_TOP_BACK_CENTER 0x10000U #define AUFMT_TOP_BACK_RIGHT 0x20000U #define AUFMT_MONAURAL AUFMT_FRONT_CENTER #define AUFMT_STEREO (AUFMT_FRONT_LEFT | AUFMT_FRONT_RIGHT) #define AUFMT_SURROUND4 (AUFMT_STEREO | AUFMT_BACK_LEFT \ | AUFMT_BACK_RIGHT) #define AUFMT_DOLBY_5_1 (AUFMT_SURROUND4 | AUFMT_FRONT_CENTER \ | AUFMT_LOW_FREQUENCY) /** * 0: frequency[0] is lower limit, and frequency[1] is higher limit. * 1-16: frequency[0] to frequency[frequency_type-1] are valid. */ u_int frequency_type; #define AUFMT_MAX_FREQUENCIES 16 /** * sampling rates */ u_int frequency[AUFMT_MAX_FREQUENCIES]; }; #ifdef AZALIA_DEBUG # define DPRINTFN(n,x) do { if (az_debug > (n)) printf x; } while (0/*CONSTCOND*/) int az_debug = 0; #else # define DPRINTFN(n,x) do {} while (0/*CONSTCOND*/) #endif /* ---------------------------------------------------------------- * ICH6/ICH7 constant values * ---------------------------------------------------------------- */ /* PCI registers */ #define ICH_PCI_HDBARL 0x10 #define ICH_PCI_HDBARU 0x14 #define ICH_PCI_HDCTL 0x40 #define ICH_PCI_HDCTL_CLKDETCLR 0x08 #define ICH_PCI_HDCTL_CLKDETEN 0x04 #define ICH_PCI_HDCTL_CLKDETINV 0x02 #define ICH_PCI_HDCTL_SIGNALMODE 0x01 /* internal types */ typedef struct { bus_dmamap_t map; caddr_t addr; /* kernel virtual address */ bus_dma_segment_t segments[1]; size_t size; } azalia_dma_t; #define AZALIA_DMA_DMAADDR(p) ((p)->map->dm_segs[0].ds_addr) typedef struct { struct azalia_t *az; int regbase; int number; int dir; /* AUMODE_PLAY or AUMODE_RECORD */ uint32_t intr_bit; azalia_dma_t bdlist; azalia_dma_t buffer; void (*intr)(void*); void *intr_arg; } stream_t; #define STR_READ_1(s, r) \ bus_space_read_1((s)->az->iot, (s)->az->ioh, (s)->regbase + HDA_SD_##r) #define STR_READ_2(s, r) \ bus_space_read_2((s)->az->iot, (s)->az->ioh, (s)->regbase + HDA_SD_##r) #define STR_READ_4(s, r) \ bus_space_read_4((s)->az->iot, (s)->az->ioh, (s)->regbase + HDA_SD_##r) #define STR_WRITE_1(s, r, v) \ bus_space_write_1((s)->az->iot, (s)->az->ioh, (s)->regbase + HDA_SD_##r, v) #define STR_WRITE_2(s, r, v) \ bus_space_write_2((s)->az->iot, (s)->az->ioh, (s)->regbase + HDA_SD_##r, v) #define STR_WRITE_4(s, r, v) \ bus_space_write_4((s)->az->iot, (s)->az->ioh, (s)->regbase + HDA_SD_##r, v) typedef struct azalia_t { struct device dev; struct device *audiodev; pci_chipset_tag_t pc; void *ih; bus_space_tag_t iot; bus_space_handle_t ioh; bus_size_t map_size; bus_dma_tag_t dmat; pcireg_t pciid; uint32_t subid; codec_t codecs[15]; int ncodecs; /* number of codecs */ int codecno; /* index of the using codec */ azalia_dma_t corb_dma; int corb_size; azalia_dma_t rirb_dma; int rirb_size; int rirb_rp; #define UNSOLQ_SIZE 256 rirb_entry_t *unsolq; int unsolq_wp; int unsolq_rp; boolean_t unsolq_kick; boolean_t ok64; int nistreams, nostreams, nbstreams; stream_t pstream; stream_t rstream; } azalia_t; #define XNAME(sc) ((sc)->dev.dv_xname) #define AZ_READ_1(z, r) bus_space_read_1((z)->iot, (z)->ioh, HDA_##r) #define AZ_READ_2(z, r) bus_space_read_2((z)->iot, (z)->ioh, HDA_##r) #define AZ_READ_4(z, r) bus_space_read_4((z)->iot, (z)->ioh, HDA_##r) #define AZ_WRITE_1(z, r, v) bus_space_write_1((z)->iot, (z)->ioh, HDA_##r, v) #define AZ_WRITE_2(z, r, v) bus_space_write_2((z)->iot, (z)->ioh, HDA_##r, v) #define AZ_WRITE_4(z, r, v) bus_space_write_4((z)->iot, (z)->ioh, HDA_##r, v) /* prototypes */ uint8_t azalia_pci_read(pci_chipset_tag_t, pcitag_t, int); void azalia_pci_write(pci_chipset_tag_t, pcitag_t, int, uint8_t); int azalia_pci_match(struct device *, void *, void *); void azalia_pci_attach(struct device *, struct device *, void *); int azalia_pci_activate(struct device *, enum devact); int azalia_pci_detach(struct device *, int); int azalia_intr(void *); void azalia_print_codec(codec_t *); int azalia_attach(azalia_t *); void azalia_attach_intr(struct device *); int azalia_init_corb(azalia_t *); int azalia_delete_corb(azalia_t *); int azalia_init_rirb(azalia_t *); int azalia_delete_rirb(azalia_t *); int azalia_set_command(azalia_t *, nid_t, int, uint32_t, uint32_t); int azalia_get_response(azalia_t *, uint32_t *); void azalia_rirb_kick_unsol_events(azalia_t *); void azalia_rirb_intr(azalia_t *); int azalia_alloc_dmamem(azalia_t *, size_t, size_t, azalia_dma_t *); int azalia_free_dmamem(const azalia_t *, azalia_dma_t*); int azalia_codec_init(codec_t *); int azalia_codec_delete(codec_t *); void azalia_codec_add_bits(codec_t *, int, uint32_t, int); void azalia_codec_add_format(codec_t *, int, int, int, uint32_t, int32_t); int azalia_codec_comresp(const codec_t *, nid_t, uint32_t, uint32_t, uint32_t *); int azalia_codec_connect_stream(codec_t *, int, uint16_t, int); int azalia_codec_disconnect_stream(codec_t *, int); void azalia_codec_print_audiofunc(const codec_t *); void azalia_codec_print_groups(const codec_t *); int azalia_widget_init(widget_t *, const codec_t *, int); int azalia_widget_label_widgets(codec_t *); int azalia_widget_init_audio(widget_t *, const codec_t *); int azalia_widget_init_pin(widget_t *, const codec_t *); int azalia_widget_init_connection(widget_t *, const codec_t *); int azalia_widget_check_conn(codec_t *, int, int); int azalia_widget_sole_conn(codec_t *, nid_t); void azalia_widget_print_widget(const widget_t *, const codec_t *); void azalia_widget_print_audio(const widget_t *, const char *); void azalia_widget_print_pin(const widget_t *); int azalia_stream_init(stream_t *, azalia_t *, int, int, int); int azalia_stream_delete(stream_t *, azalia_t *); int azalia_stream_reset(stream_t *); int azalia_stream_start(stream_t *, void *, void *, int, void (*)(void *), void *, uint16_t); int azalia_stream_halt(stream_t *); int azalia_stream_intr(stream_t *, uint32_t); int azalia_open(void *, int); void azalia_close(void *); int azalia_query_encoding(void *, audio_encoding_t *); int azalia_set_params(void *, int, int, audio_params_t *, audio_params_t *); void azalia_get_default_params(void *, int, struct audio_params*); int azalia_round_blocksize(void *, int); int azalia_halt_output(void *); int azalia_halt_input(void *); int azalia_getdev(void *, struct audio_device *); int azalia_set_port(void *, mixer_ctrl_t *); int azalia_get_port(void *, mixer_ctrl_t *); int azalia_query_devinfo(void *, mixer_devinfo_t *); void *azalia_allocm(void *, int, size_t, int, int); void azalia_freem(void *, void *, int); size_t azalia_round_buffersize(void *, int, size_t); int azalia_get_props(void *); int azalia_trigger_output(void *, void *, void *, int, void (*)(void *), void *, audio_params_t *); int azalia_trigger_input(void *, void *, void *, int, void (*)(void *), void *, audio_params_t *); int azalia_params2fmt(const audio_params_t *, uint16_t *); int azalia_create_encodings(codec_t *); int azalia_match_format(codec_t *, int, audio_params_t *); int azalia_set_params_sub(codec_t *, int, audio_params_t *); /* variables */ struct cfattach azalia_ca = { sizeof(azalia_t), azalia_pci_match, azalia_pci_attach, azalia_pci_detach, azalia_pci_activate }; struct cfdriver azalia_cd = { NULL, "azalia", DV_DULL }; struct audio_hw_if azalia_hw_if = { azalia_open, azalia_close, NULL, /* drain */ azalia_query_encoding, azalia_set_params, azalia_round_blocksize, NULL, /* commit_settings */ NULL, /* init_output */ NULL, /* init_input */ NULL, /* start_output */ NULL, /* start_input */ azalia_halt_output, azalia_halt_input, NULL, /* speaker_ctl */ azalia_getdev, NULL, /* setfd */ azalia_set_port, azalia_get_port, azalia_query_devinfo, azalia_allocm, azalia_freem, azalia_round_buffersize, NULL, /* mappage */ azalia_get_props, azalia_trigger_output, azalia_trigger_input, azalia_get_default_params }; static const char *pin_devices[16] = { AudioNline, AudioNspeaker, AudioNheadphone, AudioNcd, "SPDIF", "digital-out", "modem-line", "modem-handset", "line-in", AudioNaux, AudioNmicrophone, "telephony", "SPDIF-in", "digital-in", "beep", "other"}; static const char *wtypes[16] = { "dac", "adc", "mix", "sel", "pin", "pow", "volume", "beep", "wid08", "wid09", "wid0a", "wid0b", "wid0c", "wid0d", "wid0e", "vendor"}; /* ================================================================ * PCI functions * ================================================================ */ #define ATI_PCIE_SNOOP_REG 0x42 #define ATI_PCIE_SNOOP_MASK 0xf8 #define ATI_PCIE_SNOOP_ENABLE 0x02 #define NVIDIA_PCIE_SNOOP_REG 0x4e #define NVIDIA_PCIE_SNOOP_MASK 0xf0 #define NVIDIA_PCIE_SNOOP_ENABLE 0x0f uint8_t azalia_pci_read(pci_chipset_tag_t pc, pcitag_t pa, int reg) { return (pci_conf_read(pc, pa, (reg & ~0x03)) >> ((reg & 0x03) * 8) & 0xff); } void azalia_pci_write(pci_chipset_tag_t pc, pcitag_t pa, int reg, uint8_t val) { pcireg_t pcival; pcival = pci_conf_read(pc, pa, (reg & ~0x03)); pcival &= ~(0xff << ((reg & 0x03) * 8)); pcival |= (val << ((reg & 0x03) * 8)); pci_conf_write(pc, pa, (reg & ~0x03), pcival); } int azalia_pci_match(struct device *parent, void *match, void *aux) { struct pci_attach_args *pa; pa = aux; if (PCI_CLASS(pa->pa_class) == PCI_CLASS_MULTIMEDIA && PCI_SUBCLASS(pa->pa_class) == PCI_SUBCLASS_MULTIMEDIA_HDAUDIO) return 1; return 0; } void azalia_pci_attach(struct device *parent, struct device *self, void *aux) { azalia_t *sc; struct pci_attach_args *pa; pcireg_t v; pci_intr_handle_t ih; const char *interrupt_str; uint8_t reg; sc = (azalia_t*)self; pa = aux; sc->dmat = pa->pa_dmat; v = pci_conf_read(pa->pa_pc, pa->pa_tag, ICH_PCI_HDBARL); v &= PCI_MAPREG_TYPE_MASK | PCI_MAPREG_MEM_TYPE_MASK; if (pci_mapreg_map(pa, ICH_PCI_HDBARL, v, 0, &sc->iot, &sc->ioh, NULL, &sc->map_size, 0)) { printf(": can't map device i/o space\n"); return; } /* enable back-to-back */ v = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG); pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG, v | PCI_COMMAND_BACKTOBACK_ENABLE); v = pci_conf_read(pa->pa_pc, pa->pa_tag, 0x44); pci_conf_write(pa->pa_pc, pa->pa_tag, 0x44, v & (~0x7)); /* enable PCIe snoop */ switch (PCI_PRODUCT(pa->pa_id)) { case PCI_PRODUCT_ATI_SB450_HDA: case PCI_PRODUCT_ATI_SBX00_HDA: reg = azalia_pci_read(pa->pa_pc, pa->pa_tag, ATI_PCIE_SNOOP_REG); reg &= ATI_PCIE_SNOOP_MASK; reg |= ATI_PCIE_SNOOP_ENABLE; azalia_pci_write(pa->pa_pc, pa->pa_tag, ATI_PCIE_SNOOP_REG, reg); break; case PCI_PRODUCT_NVIDIA_MCP51_HDA: case PCI_PRODUCT_NVIDIA_MCP55_HDA: case PCI_PRODUCT_NVIDIA_MCP61_HDA_1: case PCI_PRODUCT_NVIDIA_MCP61_HDA_2: case PCI_PRODUCT_NVIDIA_MCP65_HDA_1: case PCI_PRODUCT_NVIDIA_MCP65_HDA_2: case PCI_PRODUCT_NVIDIA_MCP67_HDA_1: case PCI_PRODUCT_NVIDIA_MCP67_HDA_2: case PCI_PRODUCT_NVIDIA_MCP73_HDA_1: case PCI_PRODUCT_NVIDIA_MCP73_HDA_2: case PCI_PRODUCT_NVIDIA_MCP77_HDA_1: case PCI_PRODUCT_NVIDIA_MCP77_HDA_2: case PCI_PRODUCT_NVIDIA_MCP77_HDA_3: case PCI_PRODUCT_NVIDIA_MCP77_HDA_4: case PCI_PRODUCT_NVIDIA_MCP79_HDA_1: case PCI_PRODUCT_NVIDIA_MCP79_HDA_2: case PCI_PRODUCT_NVIDIA_MCP79_HDA_3: case PCI_PRODUCT_NVIDIA_MCP79_HDA_4: case PCI_PRODUCT_NVIDIA_MCP7B_HDA_1: case PCI_PRODUCT_NVIDIA_MCP7B_HDA_2: case PCI_PRODUCT_NVIDIA_MCP7B_HDA_3: case PCI_PRODUCT_NVIDIA_MCP7B_HDA_4: reg = azalia_pci_read(pa->pa_pc, pa->pa_tag, NVIDIA_PCIE_SNOOP_REG); reg &= NVIDIA_PCIE_SNOOP_MASK; reg |= NVIDIA_PCIE_SNOOP_ENABLE; azalia_pci_write(pa->pa_pc, pa->pa_tag, NVIDIA_PCIE_SNOOP_REG, reg); break; } /* interrupt */ if (pci_intr_map(pa, &ih)) { printf(": can't map interrupt\n"); return; } sc->pc = pa->pa_pc; interrupt_str = pci_intr_string(pa->pa_pc, ih); sc->ih = pci_intr_establish(pa->pa_pc, ih, IPL_AUDIO, azalia_intr, sc, sc->dev.dv_xname); if (sc->ih == NULL) { printf(": can't establish interrupt"); if (interrupt_str != NULL) printf(" at %s", interrupt_str); printf("\n"); return; } printf(": %s\n", interrupt_str); sc->pciid = pa->pa_id; if (azalia_attach(sc)) { printf("%s: initialization failure\n", XNAME(sc)); azalia_pci_detach(self, 0); return; } sc->subid = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_SUBSYS_ID_REG); azalia_attach_intr(self); } int azalia_pci_activate(struct device *self, enum devact act) { azalia_t *sc; int ret; sc = (azalia_t*)self; ret = 0; switch (act) { case DVACT_ACTIVATE: return ret; case DVACT_DEACTIVATE: if (sc->audiodev != NULL) ret = config_deactivate(sc->audiodev); return ret; } return EOPNOTSUPP; } int azalia_pci_detach(struct device *self, int flags) { azalia_t *az; int i; DPRINTF(("%s\n", __func__)); az = (azalia_t*)self; if (az->audiodev != NULL) { config_detach(az->audiodev, flags); az->audiodev = NULL; } DPRINTF(("%s: delete streams\n", __func__)); azalia_stream_delete(&az->rstream, az); azalia_stream_delete(&az->pstream, az); DPRINTF(("%s: delete codecs\n", __func__)); for (i = 0; i < az->ncodecs; i++) { azalia_codec_delete(&az->codecs[i]); } az->ncodecs = 0; DPRINTF(("%s: delete CORB and RIRB\n", __func__)); azalia_delete_corb(az); azalia_delete_rirb(az); DPRINTF(("%s: disable interrupts\n", __func__)); AZ_WRITE_4(az, INTCTL, 0); DPRINTF(("%s: clear interrupts\n", __func__)); AZ_WRITE_4(az, INTSTS, HDA_INTSTS_CIS | HDA_INTSTS_GIS); AZ_WRITE_2(az, STATESTS, HDA_STATESTS_SDIWAKE); AZ_WRITE_1(az, RIRBSTS, HDA_RIRBSTS_RINTFL | HDA_RIRBSTS_RIRBOIS); DPRINTF(("%s: delete PCI resources\n", __func__)); if (az->ih != NULL) { pci_intr_disestablish(az->pc, az->ih); az->ih = NULL; } if (az->map_size != 0) { bus_space_unmap(az->iot, az->ioh, az->map_size); az->map_size = 0; } return 0; } int azalia_intr(void *v) { azalia_t *az = v; int ret = 0; uint32_t intsts; uint8_t rirbsts, rirbctl; intsts = AZ_READ_4(az, INTSTS); if (intsts == 0) return (0); AZ_WRITE_4(az, INTSTS, intsts); ret += azalia_stream_intr(&az->pstream, intsts); ret += azalia_stream_intr(&az->rstream, intsts); rirbctl = AZ_READ_1(az, RIRBCTL); rirbsts = AZ_READ_1(az, RIRBSTS); if (intsts & HDA_INTSTS_CIS) { if (rirbctl & HDA_RIRBCTL_RINTCTL) { if (rirbsts & HDA_RIRBSTS_RINTFL) azalia_rirb_intr(az); } } return (1); } /* ================================================================ * HDA controller functions * ================================================================ */ void azalia_print_codec(codec_t *codec) { const char *vendor; if (codec->name == NULL) { vendor = pci_findvendor(codec->vid >> 16); if (vendor == NULL) printf("0x%04x/0x%04x", codec->vid >> 16, codec->vid & 0xffff); else printf("%s/0x%04x", vendor, codec->vid & 0xffff); } else printf("%s", codec->name); } int azalia_attach(azalia_t *az) { int i, n; uint32_t gctl; uint16_t gcap; uint16_t statests; DPRINTF(("%s: host: High Definition Audio rev. %d.%d\n", XNAME(az), AZ_READ_1(az, VMAJ), AZ_READ_1(az, VMIN))); gcap = AZ_READ_2(az, GCAP); az->nistreams = HDA_GCAP_ISS(gcap); az->nostreams = HDA_GCAP_OSS(gcap); az->nbstreams = HDA_GCAP_BSS(gcap); az->ok64 = (gcap & HDA_GCAP_64OK) != 0; DPRINTF(("%s: host: %d output, %d input, and %d bidi streams\n", XNAME(az), az->nostreams, az->nistreams, az->nbstreams)); /* 4.2.2 Starting the High Definition Audio Controller */ DPRINTF(("%s: resetting\n", __func__)); gctl = AZ_READ_4(az, GCTL); AZ_WRITE_4(az, GCTL, gctl & ~HDA_GCTL_CRST); for (i = 5000; i >= 0; i--) { DELAY(10); if ((AZ_READ_4(az, GCTL) & HDA_GCTL_CRST) == 0) break; } DPRINTF(("%s: reset counter = %d\n", __func__, i)); if (i <= 0) { printf("%s: reset failure\n", XNAME(az)); return ETIMEDOUT; } DELAY(1000); gctl = AZ_READ_4(az, GCTL); AZ_WRITE_4(az, GCTL, gctl | HDA_GCTL_CRST); for (i = 5000; i >= 0; i--) { DELAY(10); if (AZ_READ_4(az, GCTL) & HDA_GCTL_CRST) break; } DPRINTF(("%s: reset counter = %d\n", __func__, i)); if (i <= 0) { printf("%s: reset-exit failure\n", XNAME(az)); return ETIMEDOUT; } /* enable unsolicited response */ gctl = AZ_READ_4(az, GCTL); AZ_WRITE_4(az, GCTL, gctl | HDA_GCTL_UNSOL); /* 4.3 Codec discovery */ DELAY(1000); statests = AZ_READ_2(az, STATESTS); for (i = 0, n = 0; i < 15; i++) { if ((statests >> i) & 1) { DPRINTF(("%s: found a codec at #%d\n", XNAME(az), i)); az->codecs[n].address = i; az->codecs[n++].az = az; } } az->ncodecs = n; if (az->ncodecs < 1) { printf("%s: No HD-Audio codecs\n", XNAME(az)); return -1; } return 0; } void azalia_attach_intr(struct device *self) { azalia_t *az; codec_t *codec; int err, i, j, c; az = (azalia_t*)self; AZ_WRITE_2(az, STATESTS, HDA_STATESTS_SDIWAKE); AZ_WRITE_1(az, RIRBSTS, HDA_RIRBSTS_RINTFL | HDA_RIRBSTS_RIRBOIS); AZ_WRITE_4(az, INTSTS, HDA_INTSTS_CIS | HDA_INTSTS_GIS); AZ_WRITE_4(az, DPLBASE, 0); AZ_WRITE_4(az, DPUBASE, 0); /* 4.4.1 Command Outbound Ring Buffer */ if (azalia_init_corb(az)) goto err_exit; /* 4.4.2 Response Inbound Ring Buffer */ if (azalia_init_rirb(az)) goto err_exit; AZ_WRITE_4(az, INTCTL, AZ_READ_4(az, INTCTL) | HDA_INTCTL_CIE | HDA_INTCTL_GIE); c = 0; for (i = 0; i < az->ncodecs; i++) { err = azalia_codec_init(&az->codecs[i]); if (!err) c++; } if (c == 0) { printf("%s: No codecs found\n", XNAME(az)); goto err_exit; } /* Use the first codec capable of analog I/O. If there are none, * use the first codec capable of digital I/O. */ c = -1; for (i = 0; i < az->ncodecs; i++) { if (az->codecs[i].audiofunc < 0) continue; codec = &az->codecs[i]; FOR_EACH_WIDGET(codec, j) { if (codec->w[j].type == COP_AWTYPE_AUDIO_OUTPUT || codec->w[j].type == COP_AWTYPE_AUDIO_INPUT) { if (codec->w[j].widgetcap & COP_AWCAP_DIGITAL) { if (c < 0) c = i; } else { c = i; break; } } } } az->codecno = c; if (az->codecno < 0) { DPRINTF(("%s: chosen codec has no converters.\n", XNAME(az))); goto err_exit; } printf("%s: codecs: ", XNAME(az)); for (i = 0; i < az->ncodecs; i++) { azalia_print_codec(&az->codecs[i]); if (i < az->ncodecs - 1) printf(", "); } if (az->ncodecs > 1) { printf(", using "); azalia_print_codec(&az->codecs[az->codecno]); } printf("\n"); /* All codecs with audio are enabled, but only one will be used. */ for (i = 0; i < az->ncodecs; i++) { codec = &az->codecs[i]; if (i != az->codecno) { if (codec->audiofunc < 0) continue; codec->comresp(codec, codec->audiofunc, CORB_SET_POWER_STATE, CORB_PS_D3, NULL); DELAY(100); azalia_codec_delete(codec); } } /* Use stream#1 and #2. Don't use stream#0. */ if (azalia_stream_init(&az->pstream, az, az->nistreams + 0, 1, AUMODE_PLAY)) goto err_exit; if (azalia_stream_init(&az->rstream, az, 0, 2, AUMODE_RECORD)) goto err_exit; az->audiodev = audio_attach_mi(&azalia_hw_if, az, &az->dev); return; err_exit: azalia_pci_detach(self, 0); return; } int azalia_init_corb(azalia_t *az) { int entries, err, i; uint16_t corbrp, corbwp; uint8_t corbsize, cap, corbctl; /* stop the CORB */ corbctl = AZ_READ_1(az, CORBCTL); if (corbctl & HDA_CORBCTL_CORBRUN) { /* running? */ AZ_WRITE_1(az, CORBCTL, corbctl & ~HDA_CORBCTL_CORBRUN); for (i = 5000; i >= 0; i--) { DELAY(10); corbctl = AZ_READ_1(az, CORBCTL); if ((corbctl & HDA_CORBCTL_CORBRUN) == 0) break; } if (i <= 0) { printf("%s: CORB is running\n", XNAME(az)); return EBUSY; } } /* determine CORB size */ corbsize = AZ_READ_1(az, CORBSIZE); cap = corbsize & HDA_CORBSIZE_CORBSZCAP_MASK; corbsize &= ~HDA_CORBSIZE_CORBSIZE_MASK; if (cap & HDA_CORBSIZE_CORBSZCAP_256) { entries = 256; corbsize |= HDA_CORBSIZE_CORBSIZE_256; } else if (cap & HDA_CORBSIZE_CORBSZCAP_16) { entries = 16; corbsize |= HDA_CORBSIZE_CORBSIZE_16; } else if (cap & HDA_CORBSIZE_CORBSZCAP_2) { entries = 2; corbsize |= HDA_CORBSIZE_CORBSIZE_2; } else { printf("%s: Invalid CORBSZCAP: 0x%2x\n", XNAME(az), cap); return -1; } err = azalia_alloc_dmamem(az, entries * sizeof(corb_entry_t), 128, &az->corb_dma); if (err) { printf("%s: can't allocate CORB buffer\n", XNAME(az)); return err; } AZ_WRITE_4(az, CORBLBASE, (uint32_t)AZALIA_DMA_DMAADDR(&az->corb_dma)); AZ_WRITE_4(az, CORBUBASE, PTR_UPPER32(AZALIA_DMA_DMAADDR(&az->corb_dma))); AZ_WRITE_1(az, CORBSIZE, corbsize); az->corb_size = entries; DPRINTF(("%s: CORB allocation succeeded.\n", __func__)); /* reset CORBRP */ corbrp = AZ_READ_2(az, CORBRP); AZ_WRITE_2(az, CORBRP, corbrp | HDA_CORBRP_CORBRPRST); AZ_WRITE_2(az, CORBRP, corbrp & ~HDA_CORBRP_CORBRPRST); for (i = 5000; i >= 0; i--) { DELAY(10); corbrp = AZ_READ_2(az, CORBRP); if ((corbrp & HDA_CORBRP_CORBRPRST) == 0) break; } if (i <= 0) { printf("%s: CORBRP reset failure\n", XNAME(az)); return -1; } DPRINTF(("%s: CORBWP=%d; size=%d\n", __func__, AZ_READ_2(az, CORBRP) & HDA_CORBRP_CORBRP, az->corb_size)); /* clear CORBWP */ corbwp = AZ_READ_2(az, CORBWP); AZ_WRITE_2(az, CORBWP, corbwp & ~HDA_CORBWP_CORBWP); /* Run! */ corbctl = AZ_READ_1(az, CORBCTL); AZ_WRITE_1(az, CORBCTL, corbctl | HDA_CORBCTL_CORBRUN); return 0; } int azalia_delete_corb(azalia_t *az) { int i; uint8_t corbctl; if (az->corb_dma.addr == NULL) return 0; /* stop the CORB */ corbctl = AZ_READ_1(az, CORBCTL); AZ_WRITE_1(az, CORBCTL, corbctl & ~HDA_CORBCTL_CORBRUN); for (i = 5000; i >= 0; i--) { DELAY(10); corbctl = AZ_READ_1(az, CORBCTL); if ((corbctl & HDA_CORBCTL_CORBRUN) == 0) break; } azalia_free_dmamem(az, &az->corb_dma); return 0; } int azalia_init_rirb(azalia_t *az) { int entries, err, i; uint16_t rirbwp; uint8_t rirbsize, cap, rirbctl; /* stop the RIRB */ rirbctl = AZ_READ_1(az, RIRBCTL); if (rirbctl & HDA_RIRBCTL_RIRBDMAEN) { /* running? */ AZ_WRITE_1(az, RIRBCTL, rirbctl & ~HDA_RIRBCTL_RIRBDMAEN); for (i = 5000; i >= 0; i--) { DELAY(10); rirbctl = AZ_READ_1(az, RIRBCTL); if ((rirbctl & HDA_RIRBCTL_RIRBDMAEN) == 0) break; } if (i <= 0) { printf("%s: RIRB is running\n", XNAME(az)); return EBUSY; } } /* determine RIRB size */ rirbsize = AZ_READ_1(az, RIRBSIZE); cap = rirbsize & HDA_RIRBSIZE_RIRBSZCAP_MASK; rirbsize &= ~HDA_RIRBSIZE_RIRBSIZE_MASK; if (cap & HDA_RIRBSIZE_RIRBSZCAP_256) { entries = 256; rirbsize |= HDA_RIRBSIZE_RIRBSIZE_256; } else if (cap & HDA_RIRBSIZE_RIRBSZCAP_16) { entries = 16; rirbsize |= HDA_RIRBSIZE_RIRBSIZE_16; } else if (cap & HDA_RIRBSIZE_RIRBSZCAP_2) { entries = 2; rirbsize |= HDA_RIRBSIZE_RIRBSIZE_2; } else { printf("%s: Invalid RIRBSZCAP: 0x%2x\n", XNAME(az), cap); return -1; } err = azalia_alloc_dmamem(az, entries * sizeof(rirb_entry_t), 128, &az->rirb_dma); if (err) { printf("%s: can't allocate RIRB buffer\n", XNAME(az)); return err; } AZ_WRITE_4(az, RIRBLBASE, (uint32_t)AZALIA_DMA_DMAADDR(&az->rirb_dma)); AZ_WRITE_4(az, RIRBUBASE, PTR_UPPER32(AZALIA_DMA_DMAADDR(&az->rirb_dma))); AZ_WRITE_1(az, RIRBSIZE, rirbsize); az->rirb_size = entries; DPRINTF(("%s: RIRB allocation succeeded.\n", __func__)); /* setup the unsolicited response queue */ az->unsolq_rp = 0; az->unsolq_wp = 0; az->unsolq_kick = FALSE; az->unsolq = malloc(sizeof(rirb_entry_t) * UNSOLQ_SIZE, M_DEVBUF, M_NOWAIT | M_ZERO); if (az->unsolq == NULL) { DPRINTF(("%s: can't allocate unsolicited response queue.\n", XNAME(az))); azalia_free_dmamem(az, &az->rirb_dma); return ENOMEM; } /* reset the write pointer */ rirbwp = AZ_READ_2(az, RIRBWP); AZ_WRITE_2(az, RIRBWP, rirbwp | HDA_RIRBWP_RIRBWPRST); /* clear the read pointer */ az->rirb_rp = AZ_READ_2(az, RIRBWP) & HDA_RIRBWP_RIRBWP; DPRINTF(("%s: RIRBRP=%d, size=%d\n", __func__, az->rirb_rp, az->rirb_size)); AZ_WRITE_2(az, RINTCNT, 1); /* Run! */ rirbctl = AZ_READ_1(az, RIRBCTL); AZ_WRITE_1(az, RIRBCTL, rirbctl | HDA_RIRBCTL_RIRBDMAEN | HDA_RIRBCTL_RINTCTL); return (0); } int azalia_delete_rirb(azalia_t *az) { int i; uint8_t rirbctl; if (az->unsolq != NULL) { free(az->unsolq, M_DEVBUF); az->unsolq = NULL; } if (az->rirb_dma.addr == NULL) return 0; /* stop the RIRB */ rirbctl = AZ_READ_1(az, RIRBCTL); AZ_WRITE_1(az, RIRBCTL, rirbctl & ~HDA_RIRBCTL_RIRBDMAEN); for (i = 5000; i >= 0; i--) { DELAY(10); rirbctl = AZ_READ_1(az, RIRBCTL); if ((rirbctl & HDA_RIRBCTL_RIRBDMAEN) == 0) break; } azalia_free_dmamem(az, &az->rirb_dma); return 0; } int azalia_set_command(azalia_t *az, int caddr, nid_t nid, uint32_t control, uint32_t param) { corb_entry_t *corb; int wp; uint32_t verb; uint16_t corbwp; uint8_t rirbctl; #ifdef DIAGNOSTIC if ((AZ_READ_1(az, CORBCTL) & HDA_CORBCTL_CORBRUN) == 0) { printf("%s: CORB is not running.\n", XNAME(az)); return -1; } #endif verb = (caddr << 28) | (nid << 20) | (control << 8) | param; corbwp = AZ_READ_2(az, CORBWP); wp = corbwp & HDA_CORBWP_CORBWP; corb = (corb_entry_t*)az->corb_dma.addr; if (++wp >= az->corb_size) wp = 0; corb[wp] = verb; /* disable RIRB interrupts */ rirbctl = AZ_READ_1(az, RIRBCTL); if (rirbctl & HDA_RIRBCTL_RINTCTL) { AZ_WRITE_1(az, RIRBCTL, rirbctl & ~HDA_RIRBCTL_RINTCTL); azalia_rirb_intr(az); } AZ_WRITE_2(az, CORBWP, (corbwp & ~HDA_CORBWP_CORBWP) | wp); #if 0 DPRINTF(("%s: caddr=%d nid=%d control=0x%x param=0x%x verb=0x%8.8x wp=%d\n", __func__, caddr, nid, control, param, verb, wp)); #endif return 0; } int azalia_get_response(azalia_t *az, uint32_t *result) { const rirb_entry_t *rirb; int i; uint16_t wp; uint8_t rirbctl; #ifdef DIAGNOSTIC if ((AZ_READ_1(az, RIRBCTL) & HDA_RIRBCTL_RIRBDMAEN) == 0) { printf("%s: RIRB is not running.\n", XNAME(az)); return -1; } #endif for (i = 5000; i >= 0; i--) { wp = AZ_READ_2(az, RIRBWP) & HDA_RIRBWP_RIRBWP; if (az->rirb_rp != wp) break; DELAY(10); } if (i <= 0) { printf("%s: RIRB time out\n", XNAME(az)); return ETIMEDOUT; } rirb = (rirb_entry_t*)az->rirb_dma.addr; for (;;) { if (++az->rirb_rp >= az->rirb_size) az->rirb_rp = 0; if (rirb[az->rirb_rp].resp_ex & RIRB_RESP_UNSOL) { az->unsolq[az->unsolq_wp].resp = rirb[az->rirb_rp].resp; az->unsolq[az->unsolq_wp++].resp_ex = rirb[az->rirb_rp].resp_ex; az->unsolq_wp %= UNSOLQ_SIZE; } else break; } if (result != NULL) *result = rirb[az->rirb_rp].resp; azalia_rirb_kick_unsol_events(az); #if 0 for (i = 0; i < 16 /*az->rirb_size*/; i++) { DPRINTF(("rirb[%d] 0x%8.8x:0x%8.8x ", i, rirb[i].resp, rirb[i].resp_ex)); if ((i % 2) == 1) DPRINTF(("\n")); } #endif /* re-enable RIRB interrupts */ rirbctl = AZ_READ_1(az, RIRBCTL); AZ_WRITE_1(az, RIRBCTL, rirbctl | HDA_RIRBCTL_RINTCTL); return 0; } void azalia_rirb_kick_unsol_events(azalia_t *az) { if (az->unsolq_kick) return; az->unsolq_kick = TRUE; while (az->unsolq_rp != az->unsolq_wp) { int i; int tag; codec_t *codec; i = RIRB_RESP_CODEC(az->unsolq[az->unsolq_rp].resp_ex); tag = RIRB_UNSOL_TAG(az->unsolq[az->unsolq_rp].resp); codec = &az->codecs[i]; DPRINTF(("%s: codec#=%d tag=%d\n", __func__, i, tag)); az->unsolq_rp++; az->unsolq_rp %= UNSOLQ_SIZE; if (codec->unsol_event != NULL) codec->unsol_event(codec, tag); } az->unsolq_kick = FALSE; } void azalia_rirb_intr(azalia_t *az) { const rirb_entry_t *rirb; uint16_t wp; uint8_t rirbsts; rirbsts = AZ_READ_1(az, RIRBSTS); wp = AZ_READ_2(az, RIRBWP) & HDA_RIRBWP_RIRBWP; rirb = (rirb_entry_t*)az->rirb_dma.addr; while (az->rirb_rp != wp) { if (++az->rirb_rp >= az->rirb_size) az->rirb_rp = 0; if (rirb[az->rirb_rp].resp_ex & RIRB_RESP_UNSOL) { az->unsolq[az->unsolq_wp].resp = rirb[az->rirb_rp].resp; az->unsolq[az->unsolq_wp++].resp_ex = rirb[az->rirb_rp].resp_ex; az->unsolq_wp %= UNSOLQ_SIZE; } else { break; } } azalia_rirb_kick_unsol_events(az); AZ_WRITE_1(az, RIRBSTS, rirbsts | HDA_RIRBSTS_RIRBOIS | HDA_RIRBSTS_RINTFL); } int azalia_alloc_dmamem(azalia_t *az, size_t size, size_t align, azalia_dma_t *d) { int err; int nsegs; d->size = size; err = bus_dmamem_alloc(az->dmat, size, align, 0, d->segments, 1, &nsegs, BUS_DMA_NOWAIT); if (err) return err; if (nsegs != 1) goto free; err = bus_dmamem_map(az->dmat, d->segments, 1, size, &d->addr, BUS_DMA_NOWAIT | BUS_DMA_COHERENT | BUS_DMA_NOCACHE); if (err) goto free; err = bus_dmamap_create(az->dmat, size, 1, size, 0, BUS_DMA_NOWAIT, &d->map); if (err) goto unmap; err = bus_dmamap_load(az->dmat, d->map, d->addr, size, NULL, BUS_DMA_NOWAIT); if (err) goto destroy; if (!az->ok64 && PTR_UPPER32(AZALIA_DMA_DMAADDR(d)) != 0) { azalia_free_dmamem(az, d); return -1; } return 0; destroy: bus_dmamap_destroy(az->dmat, d->map); unmap: bus_dmamem_unmap(az->dmat, d->addr, size); free: bus_dmamem_free(az->dmat, d->segments, 1); d->addr = NULL; return err; } int azalia_free_dmamem(const azalia_t *az, azalia_dma_t* d) { if (d->addr == NULL) return 0; bus_dmamap_unload(az->dmat, d->map); bus_dmamap_destroy(az->dmat, d->map); bus_dmamem_unmap(az->dmat, d->addr, d->size); bus_dmamem_free(az->dmat, d->segments, 1); d->addr = NULL; return 0; } /* ================================================================ * HDA codec functions * ================================================================ */ int azalia_codec_init(codec_t *this) { uint32_t rev, id, result; int err, addr, n, i; this->comresp = azalia_codec_comresp; addr = this->address; /* codec vendor/device/revision */ err = this->comresp(this, CORB_NID_ROOT, CORB_GET_PARAMETER, COP_REVISION_ID, &rev); if (err) return err; err = this->comresp(this, CORB_NID_ROOT, CORB_GET_PARAMETER, COP_VENDOR_ID, &id); if (err) return err; this->vid = id; this->subid = this->az->subid; azalia_codec_init_vtbl(this); DPRINTF(("%s: codec[%d] vid 0x%8.8x, subid 0x%8.8x, rev. %u.%u,", XNAME(this->az), addr, this->vid, this->subid, COP_RID_REVISION(rev), COP_RID_STEPPING(rev))); DPRINTF((" HDA version %u.%u\n", COP_RID_MAJ(rev), COP_RID_MIN(rev))); /* identify function nodes */ err = this->comresp(this, CORB_NID_ROOT, CORB_GET_PARAMETER, COP_SUBORDINATE_NODE_COUNT, &result); if (err) return err; this->nfunctions = COP_NSUBNODES(result); if (COP_NSUBNODES(result) <= 0) { DPRINTF(("%s: codec[%d]: No function groups\n", XNAME(this->az), addr)); return -1; } /* iterate function nodes and find an audio function */ n = COP_START_NID(result); DPRINTF(("%s: nidstart=%d #functions=%d\n", XNAME(this->az), n, this->nfunctions)); this->audiofunc = -1; for (i = 0; i < this->nfunctions; i++) { err = this->comresp(this, n + i, CORB_GET_PARAMETER, COP_FUNCTION_GROUP_TYPE, &result); if (err) continue; DPRINTF(("%s: FTYPE result = 0x%8.8x\n", __func__, result)); if (COP_FTYPE(result) == COP_FTYPE_AUDIO) { this->audiofunc = n + i; break; /* XXX multiple audio functions? */ } } if (this->audiofunc < 0) { DPRINTF(("%s: codec[%d]: No audio function groups\n", XNAME(this->az), addr)); this->comresp(this, this->audiofunc, CORB_SET_POWER_STATE, CORB_PS_D3, &result); DELAY(100); return -1; } /* power the audio function */ this->comresp(this, this->audiofunc, CORB_SET_POWER_STATE, CORB_PS_D0, &result); DELAY(100); /* check widgets in the audio function */ err = this->comresp(this, this->audiofunc, CORB_GET_PARAMETER, COP_SUBORDINATE_NODE_COUNT, &result); if (err) return err; DPRINTF(("%s: There are %d widgets in the audio function.\n", __func__, COP_NSUBNODES(result))); this->wstart = COP_START_NID(result); if (this->wstart < 2) { printf("%s: invalid node structure\n", XNAME(this->az)); return -1; } this->wend = this->wstart + COP_NSUBNODES(result); this->w = malloc(sizeof(widget_t) * this->wend, M_DEVBUF, M_NOWAIT | M_ZERO); if (this->w == NULL) { printf("%s: out of memory\n", XNAME(this->az)); return ENOMEM; } /* query the base parameters */ this->comresp(this, this->audiofunc, CORB_GET_PARAMETER, COP_STREAM_FORMATS, &result); this->w[this->audiofunc].d.audio.encodings = result; this->comresp(this, this->audiofunc, CORB_GET_PARAMETER, COP_PCM, &result); this->w[this->audiofunc].d.audio.bits_rates = result; this->comresp(this, this->audiofunc, CORB_GET_PARAMETER, COP_INPUT_AMPCAP, &result); this->w[this->audiofunc].inamp_cap = result; this->comresp(this, this->audiofunc, CORB_GET_PARAMETER, COP_OUTPUT_AMPCAP, &result); this->w[this->audiofunc].outamp_cap = result; azalia_codec_print_audiofunc(this); strlcpy(this->w[CORB_NID_ROOT].name, "root", sizeof(this->w[CORB_NID_ROOT].name)); strlcpy(this->w[this->audiofunc].name, "hdaudio", sizeof(this->w[this->audiofunc].name)); FOR_EACH_WIDGET(this, i) { err = azalia_widget_init(&this->w[i], this, i); if (err) return err; err = azalia_widget_init_connection(&this->w[i], this); if (err) return err; azalia_widget_print_widget(&this->w[i], this); if (this->init_widget != NULL) this->init_widget(this, &this->w[i], this->w[i].nid); } /* Find widgets without any enabled inputs and disable them. * Must be done after all widgets are initialized and * their connections created. */ FOR_EACH_WIDGET(this, i) { if (this->w[i].type == COP_AWTYPE_AUDIO_MIXER || this->w[i].type == COP_AWTYPE_AUDIO_SELECTOR) { if (!azalia_widget_check_conn(this, i, 0)) this->w[i].enable = 0; } } err = this->init_dacgroup(this); if (err) return err; err = azalia_widget_label_widgets(this); if (err) return err; azalia_codec_print_groups(this); err = azalia_codec_construct_format(this, 0, 0); if (err) return err; return this->mixer_init(this); } int azalia_codec_delete(codec_t *this) { if (this->mixer_delete != NULL) this->mixer_delete(this); if (this->formats != NULL) { free(this->formats, M_DEVBUF); this->formats = NULL; } this->nformats = 0; if (this->encs != NULL) { free(this->encs, M_DEVBUF); this->encs = NULL; } this->nencs = 0; if (this->w != NULL) { free(this->w, M_DEVBUF); this->w = NULL; } return 0; } int azalia_codec_construct_format(codec_t *this, int newdac, int newadc) { const convgroup_t *group; uint32_t bits_rates; int variation; int nbits, c, chan, i, err; nid_t nid; variation = 0; if (this->dacs.ngroups > 0 && newdac < this->dacs.ngroups && newdac >= 0) { this->dacs.cur = newdac; group = &this->dacs.groups[this->dacs.cur]; bits_rates = this->w[group->conv[0]].d.audio.bits_rates; nbits = 0; if (bits_rates & COP_PCM_B8) nbits++; if (bits_rates & COP_PCM_B16) nbits++; if (bits_rates & COP_PCM_B20) nbits++; if (bits_rates & COP_PCM_B24) nbits++; if (bits_rates & COP_PCM_B32) nbits++; if (nbits == 0) { printf("%s: invalid DAC PCM format: 0x%8.8x\n", XNAME(this->az), bits_rates); return -1; } variation += group->nconv * nbits; } if (this->adcs.ngroups > 0 && newadc < this->adcs.ngroups && newadc >= 0) { this->adcs.cur = newadc; group = &this->adcs.groups[this->adcs.cur]; bits_rates = this->w[group->conv[0]].d.audio.bits_rates; nbits = 0; if (bits_rates & COP_PCM_B8) nbits++; if (bits_rates & COP_PCM_B16) nbits++; if (bits_rates & COP_PCM_B20) nbits++; if (bits_rates & COP_PCM_B24) nbits++; if (bits_rates & COP_PCM_B32) nbits++; if (nbits == 0) { printf("%s: invalid ADC PCM format: 0x%8.8x\n", XNAME(this->az), bits_rates); return -1; } variation += group->nconv * nbits; } if (variation == 0) { DPRINTF(("%s: no converter groups\n", XNAME(this->az))); return -1; } if (this->formats != NULL) free(this->formats, M_DEVBUF); this->nformats = 0; this->formats = malloc(sizeof(struct audio_format) * variation, M_DEVBUF, M_NOWAIT | M_ZERO); if (this->formats == NULL) { printf("%s: out of memory in %s\n", XNAME(this->az), __func__); return ENOMEM; } /* register formats for playback */ if (this->dacs.ngroups > 0) { group = &this->dacs.groups[this->dacs.cur]; for (c = 0; c < group->nconv; c++) { chan = 0; bits_rates = ~0; for (i = 0; i <= c; i++) { nid = group->conv[i]; chan += WIDGET_CHANNELS(&this->w[nid]); bits_rates &= this->w[nid].d.audio.bits_rates; } azalia_codec_add_bits(this, chan, bits_rates, AUMODE_PLAY); } } /* register formats for recording */ if (this->adcs.ngroups > 0) { group = &this->adcs.groups[this->adcs.cur]; for (c = 0; c < group->nconv; c++) { chan = 0; bits_rates = ~0; for (i = 0; i <= c; i++) { nid = group->conv[i]; chan += WIDGET_CHANNELS(&this->w[nid]); bits_rates &= this->w[nid].d.audio.bits_rates; } azalia_codec_add_bits(this, chan, bits_rates, AUMODE_RECORD); } } err = azalia_create_encodings(this); if (err) return err; return 0; } void azalia_codec_add_bits(codec_t *this, int chan, uint32_t bits_rates, int mode) { if (bits_rates & COP_PCM_B8) azalia_codec_add_format(this, chan, 8, 16, bits_rates, mode); if (bits_rates & COP_PCM_B16) azalia_codec_add_format(this, chan, 16, 16, bits_rates, mode); if (bits_rates & COP_PCM_B20) azalia_codec_add_format(this, chan, 20, 32, bits_rates, mode); if (bits_rates & COP_PCM_B24) azalia_codec_add_format(this, chan, 24, 32, bits_rates, mode); if (bits_rates & COP_PCM_B32) azalia_codec_add_format(this, chan, 32, 32, bits_rates, mode); } void azalia_codec_add_format(codec_t *this, int chan, int valid, int prec, uint32_t rates, int32_t mode) { struct audio_format *f; f = &this->formats[this->nformats++]; f->mode = mode; f->encoding = AUDIO_ENCODING_SLINEAR_LE; if (valid == 8 && prec == 8) f->encoding = AUDIO_ENCODING_ULINEAR_LE; f->validbits = valid; f->precision = prec; f->channels = chan; switch (chan) { case 1: f->channel_mask = AUFMT_MONAURAL; break; case 2: f->channel_mask = AUFMT_STEREO; break; case 4: f->channel_mask = AUFMT_SURROUND4; break; case 6: f->channel_mask = AUFMT_DOLBY_5_1; break; case 8: f->channel_mask = AUFMT_DOLBY_5_1 | AUFMT_SIDE_LEFT | AUFMT_SIDE_RIGHT; break; default: f->channel_mask = 0; } f->frequency_type = 0; if (rates & COP_PCM_R80) f->frequency[f->frequency_type++] = 8000; if (rates & COP_PCM_R110) f->frequency[f->frequency_type++] = 11025; if (rates & COP_PCM_R160) f->frequency[f->frequency_type++] = 16000; if (rates & COP_PCM_R220) f->frequency[f->frequency_type++] = 22050; if (rates & COP_PCM_R320) f->frequency[f->frequency_type++] = 32000; if (rates & COP_PCM_R441) f->frequency[f->frequency_type++] = 44100; if (rates & COP_PCM_R480) f->frequency[f->frequency_type++] = 48000; if (rates & COP_PCM_R882) f->frequency[f->frequency_type++] = 88200; if (rates & COP_PCM_R960) f->frequency[f->frequency_type++] = 96000; if (rates & COP_PCM_R1764) f->frequency[f->frequency_type++] = 176400; if (rates & COP_PCM_R1920) f->frequency[f->frequency_type++] = 192000; if (rates & COP_PCM_R3840) f->frequency[f->frequency_type++] = 384000; } int azalia_codec_comresp(const codec_t *codec, nid_t nid, uint32_t control, uint32_t param, uint32_t* result) { int err, s; s = splaudio(); err = azalia_set_command(codec->az, codec->address, nid, control, param); if (err) goto exit; err = azalia_get_response(codec->az, result); exit: splx(s); return err; } int azalia_codec_connect_stream(codec_t *this, int dir, uint16_t fmt, int number) { const convgroup_t *group; uint32_t v; int i, err, startchan, nchan; nid_t nid; boolean_t flag222; DPRINTFN(1, ("%s: fmt=0x%4.4x number=%d\n", __func__, fmt, number)); err = 0; if (dir == AUMODE_RECORD) group = &this->adcs.groups[this->adcs.cur]; else group = &this->dacs.groups[this->dacs.cur]; flag222 = group->nconv >= 3 && (WIDGET_CHANNELS(&this->w[group->conv[0]]) == 2) && (WIDGET_CHANNELS(&this->w[group->conv[1]]) == 2) && (WIDGET_CHANNELS(&this->w[group->conv[2]]) == 2); nchan = (fmt & HDA_SD_FMT_CHAN) + 1; startchan = 0; for (i = 0; i < group->nconv; i++) { uint32_t stream_chan; nid = group->conv[i]; /* surround and c/lfe handling */ if (nchan >= 6 && flag222 && i == 1) { nid = group->conv[2]; } else if (nchan >= 6 && flag222 && i == 2) { nid = group->conv[1]; } if (startchan >= nchan) stream_chan = 0; /* stream#0 */ else stream_chan = (number << 4) | startchan; err = this->comresp(this, nid, CORB_SET_CONVERTER_FORMAT, fmt, NULL); if (err) goto exit; err = this->comresp(this, nid, CORB_SET_CONVERTER_STREAM_CHANNEL, stream_chan, NULL); if (err) goto exit; if (this->w[nid].widgetcap & COP_AWCAP_DIGITAL) { /* enable S/PDIF */ this->comresp(this, nid, CORB_GET_DIGITAL_CONTROL, 0, &v); v = (v & 0xff) | CORB_DCC_DIGEN; this->comresp(this, nid, CORB_SET_DIGITAL_CONTROL_L, v, NULL); } startchan += WIDGET_CHANNELS(&this->w[nid]); } exit: DPRINTFN(1, ("%s: leave with %d\n", __func__, err)); return err; } int azalia_codec_disconnect_stream(codec_t *this, int dir) { const convgroup_t *group; uint32_t v; int i; nid_t nid; if (dir == AUMODE_RECORD) group = &this->adcs.groups[this->adcs.cur]; else group = &this->dacs.groups[this->dacs.cur]; for (i = 0; i < group->nconv; i++) { nid = group->conv[i]; this->comresp(this, nid, CORB_SET_CONVERTER_STREAM_CHANNEL, 0, NULL); /* stream#0 */ if (this->w[nid].widgetcap & COP_AWCAP_DIGITAL) { /* disable S/PDIF */ this->comresp(this, nid, CORB_GET_DIGITAL_CONTROL, 0, &v); v = (v & ~CORB_DCC_DIGEN) & 0xff; this->comresp(this, nid, CORB_SET_DIGITAL_CONTROL_L, v, NULL); } } return 0; } /* ================================================================ * HDA widget functions * ================================================================ */ int azalia_widget_init(widget_t *this, const codec_t *codec, nid_t nid) { uint32_t result; int err; err = codec->comresp(codec, nid, CORB_GET_PARAMETER, COP_AUDIO_WIDGET_CAP, &result); if (err) return err; this->nid = nid; this->widgetcap = result; this->type = COP_AWCAP_TYPE(result); if (this->widgetcap & COP_AWCAP_POWER) { codec->comresp(codec, nid, CORB_SET_POWER_STATE, CORB_PS_D0, &result); DELAY(100); } this->enable = 1; switch (this->type) { case COP_AWTYPE_AUDIO_OUTPUT: /* FALLTHROUGH */ case COP_AWTYPE_AUDIO_INPUT: azalia_widget_init_audio(this, codec); break; case COP_AWTYPE_PIN_COMPLEX: azalia_widget_init_pin(this, codec); break; case COP_AWTYPE_VOLUME_KNOB: err = codec->comresp(codec, this->nid, CORB_GET_PARAMETER, COP_VOLUME_KNOB_CAPABILITIES, &result); if (err) return err; this->d.volume.cap = result; break; case COP_AWTYPE_POWER: this->enable = 0; break; } /* amplifier information */ if (this->widgetcap & COP_AWCAP_INAMP) { if (this->widgetcap & COP_AWCAP_AMPOV) codec->comresp(codec, nid, CORB_GET_PARAMETER, COP_INPUT_AMPCAP, &this->inamp_cap); else this->inamp_cap = codec->w[codec->audiofunc].inamp_cap; } if (this->widgetcap & COP_AWCAP_OUTAMP) { if (this->widgetcap & COP_AWCAP_AMPOV) codec->comresp(codec, nid, CORB_GET_PARAMETER, COP_OUTPUT_AMPCAP, &this->outamp_cap); else this->outamp_cap = codec->w[codec->audiofunc].outamp_cap; } return 0; } int azalia_widget_sole_conn(codec_t *this, nid_t nid) { int i, j, target; /* connected to ADC */ for (i = 0; i < this->adcs.ngroups; i++) { for (j = 0; j < this->adcs.groups[i].nconv; j++) { target = this->adcs.groups[i].conv[j]; if (this->w[target].nconnections == 1 && this->w[target].connections[0] == nid) { return target; } } } /* connected to DAC */ for (i = 0; i < this->dacs.ngroups; i++) { for (j = 0; j < this->dacs.groups[i].nconv; j++) { target = this->dacs.groups[i].conv[j]; if (this->w[target].nconnections == 1 && this->w[target].connections[0] == nid) { return target; } } } /* connected to pin complex */ j = -1; FOR_EACH_WIDGET(this, i) { if (this->w[i].type == COP_AWTYPE_PIN_COMPLEX && this->w[i].nconnections == 1 && this->w[i].connections[0] == nid) { if (j != -1) return -1; j = i; } } if (j != -1) return j; return -1; } int azalia_widget_label_widgets(codec_t *codec) { widget_t *w; int types[16]; int pins[16]; int i, j; bzero(&pins, sizeof(pins)); bzero(&types, sizeof(types)); FOR_EACH_WIDGET(codec, i) { w = &codec->w[i]; w->mixer_class = -1; /* default for disabled/unused widgets */ snprintf(w->name, sizeof(w->name), "u-wid%2.2x", w->nid); if (w->enable == 0) continue; switch (w->type) { case COP_AWTYPE_PIN_COMPLEX: pins[w->d.pin.device]++; if (pins[w->d.pin.device] > 1) snprintf(w->name, sizeof(w->name), "%s%d", pin_devices[w->d.pin.device], pins[w->d.pin.device]); else snprintf(w->name, sizeof(w->name), "%s", pin_devices[w->d.pin.device]); break; case COP_AWTYPE_AUDIO_OUTPUT: if (codec->dacs.ngroups < 1) break; for (j = 0; j < codec->dacs.groups[0].nconv; j++) { if (w->nid == codec->dacs.groups[0].conv[j]) { if (j > 0) snprintf(w->name, sizeof(w->name), "%s%d", wtypes[w->type], j + 1); else snprintf(w->name, sizeof(w->name), "%s", wtypes[w->type]); break; } } if (codec->dacs.ngroups < 2) break; for (j = 0; j < codec->dacs.groups[1].nconv; j++) { if (w->nid == codec->dacs.groups[1].conv[j]) { if (j > 0) snprintf(w->name, sizeof(w->name), "dig-%s%d", wtypes[w->type], j + 1); else snprintf(w->name, sizeof(w->name), "dig-%s", wtypes[w->type]); } } break; case COP_AWTYPE_AUDIO_INPUT: if (codec->adcs.ngroups < 1) break; w->mixer_class = AZ_CLASS_RECORD; for (j = 0; j < codec->adcs.groups[0].nconv; j++) { if (w->nid == codec->adcs.groups[0].conv[j]) { if (j > 0) snprintf(w->name, sizeof(w->name), "%s%d", wtypes[w->type], j + 1); else snprintf(w->name, sizeof(w->name), "%s", wtypes[w->type]); } } if (codec->adcs.ngroups < 2) break; for (j = 0; j < codec->adcs.groups[1].nconv; j++) { if (w->nid == codec->adcs.groups[1].conv[j]) { if (j > 0) snprintf(w->name, sizeof(w->name), "dig-%s%d", wtypes[w->type], j + 1); else snprintf(w->name, sizeof(w->name), "dig-%s", wtypes[w->type]); } } break; default: types[w->type]++; if (types[w->type] > 1) snprintf(w->name, sizeof(w->name), "%s%d", wtypes[w->type], types[w->type]); else snprintf(w->name, sizeof(w->name), "%s", wtypes[w->type]); break; } } /* Mixers and selectors that connect to only one other widget are * functionally part of the widget they are connected to. Show that * relationship in the name. */ FOR_EACH_WIDGET(codec, i) { if (codec->w[i].type != COP_AWTYPE_AUDIO_MIXER && codec->w[i].type != COP_AWTYPE_AUDIO_SELECTOR) continue; if (codec->w[i].enable == 0) continue; j = azalia_widget_sole_conn(codec, i); if (j == -1) { /* Special case. A selector with outamp capabilities * and is connected to a single widget that has no * inamp capabilities. This widget serves only to act * as the input amp for the widget it is connected to. */ if (codec->w[i].type == COP_AWTYPE_AUDIO_SELECTOR && (codec->w[i].widgetcap & COP_AWCAP_OUTAMP) && codec->w[i].nconnections == 1) { j = codec->w[i].connections[0]; if (!azalia_widget_enabled(codec, j)) continue; if (!(codec->w[j].widgetcap & COP_AWCAP_INAMP)) codec->w[i].mixer_class = AZ_CLASS_INPUT; else continue; } } if (j >= 0) { /* As part of a disabled widget, this widget * should be disabled as well. */ if (codec->w[j].enable == 0) { codec->w[i].enable = 0; snprintf(codec->w[i].name, sizeof(codec->w[i].name), "%s", "u-wid%2.2x", i); continue; } snprintf(codec->w[i].name, sizeof(codec->w[i].name), "%s", codec->w[j].name); if (codec->w[j].mixer_class == AZ_CLASS_RECORD) codec->w[i].mixer_class = AZ_CLASS_RECORD; } } return 0; } int azalia_widget_init_audio(widget_t *this, const codec_t *codec) { uint32_t result; int err; /* check audio format */ if (this->widgetcap & COP_AWCAP_FORMATOV) { err = codec->comresp(codec, this->nid, CORB_GET_PARAMETER, COP_STREAM_FORMATS, &result); if (err) return err; this->d.audio.encodings = result; if (result == 0) { /* quirk for CMI9880. * This must not occur usually... */ this->d.audio.encodings = codec->w[codec->audiofunc].d.audio.encodings; this->d.audio.bits_rates = codec->w[codec->audiofunc].d.audio.bits_rates; } else { if ((result & COP_STREAM_FORMAT_PCM) == 0) { printf("%s: %s: No PCM support: %x\n", XNAME(codec->az), this->name, result); return -1; } err = codec->comresp(codec, this->nid, CORB_GET_PARAMETER, COP_PCM, &result); if (err) return err; this->d.audio.bits_rates = result; } } else { this->d.audio.encodings = codec->w[codec->audiofunc].d.audio.encodings; this->d.audio.bits_rates = codec->w[codec->audiofunc].d.audio.bits_rates; } return 0; } int azalia_widget_init_pin(widget_t *this, const codec_t *codec) { typedef enum { PIN_DIR_IN, PIN_DIR_OUT, PIN_DIR_MIC } pintype_t; pintype_t pintype = PIN_DIR_IN; codec_t *wcodec; uint32_t result; int err; err = codec->comresp(codec, this->nid, CORB_GET_CONFIGURATION_DEFAULT, 0, &result); if (err) return err; this->d.pin.config = result; this->d.pin.sequence = CORB_CD_SEQUENCE(result); this->d.pin.association = CORB_CD_ASSOCIATION(result); this->d.pin.color = CORB_CD_COLOR(result); this->d.pin.device = CORB_CD_DEVICE(result); err = codec->comresp(codec, this->nid, CORB_GET_PARAMETER, COP_PINCAP, &result); if (err) return err; this->d.pin.cap = result; switch (this->d.pin.device) { case CORB_CD_LINEOUT: case CORB_CD_SPEAKER: case CORB_CD_HEADPHONE: case CORB_CD_SPDIFOUT: case CORB_CD_DIGITALOUT: pintype = PIN_DIR_OUT; break; case CORB_CD_CD: case CORB_CD_LINEIN: case CORB_CD_SPDIFIN: case CORB_CD_DIGITALIN: pintype = PIN_DIR_IN; break; case CORB_CD_MICIN: pintype = PIN_DIR_MIC; break; } if (pintype == PIN_DIR_IN && !(this->d.pin.cap & COP_PINCAP_INPUT)) pintype = PIN_DIR_OUT; if (pintype == PIN_DIR_OUT && !(this->d.pin.cap & COP_PINCAP_OUTPUT)) pintype = PIN_DIR_IN; switch (pintype) { case PIN_DIR_IN: codec->comresp(codec, this->nid, CORB_SET_PIN_WIDGET_CONTROL, CORB_PWC_INPUT, NULL); break; case PIN_DIR_OUT: codec->comresp(codec, this->nid, CORB_SET_PIN_WIDGET_CONTROL, CORB_PWC_OUTPUT, NULL); break; case PIN_DIR_MIC: codec->comresp(codec, this->nid, CORB_SET_PIN_WIDGET_CONTROL, CORB_PWC_INPUT|CORB_PWC_VREF_80, NULL); break; } if (this->d.pin.cap & COP_PINCAP_EAPD) { err = codec->comresp(codec, this->nid, CORB_GET_EAPD_BTL_ENABLE, 0, &result); if (err) return err; result &= 0xff; result |= CORB_EAPD_EAPD; err = codec->comresp(codec, this->nid, CORB_SET_EAPD_BTL_ENABLE, result, &result); if (err) return err; } /* Disable unconnected pins */ if (CORB_CD_PORT(this->d.pin.config) == CORB_CD_NONE) { this->enable = 0; return 0; } /* need a non const codec pointer */ wcodec = &codec->az->codecs[codec->az->codecno]; if (codec->nsense_pins < HDA_MAX_SENSE_PINS && this->d.pin.cap & COP_PINCAP_PRESENCE && CORB_CD_PORT(this->d.pin.config) == CORB_CD_JACK) { /* check override bit */ err = codec->comresp(codec, this->nid, CORB_GET_CONFIGURATION_DEFAULT, 0, &result); if (err) return err; if (!(CORB_CD_MISC(result) & CORB_CD_PRESENCEOV)) { wcodec->sense_pins[codec->nsense_pins] = this->nid; wcodec->nsense_pins++; } } return 0; } int azalia_widget_init_connection(widget_t *this, const codec_t *codec) { uint32_t result; int err; boolean_t longform; int length, i; this->selected = -1; if ((this->widgetcap & COP_AWCAP_CONNLIST) == 0) return 0; err = codec->comresp(codec, this->nid, CORB_GET_PARAMETER, COP_CONNECTION_LIST_LENGTH, &result); if (err) return err; longform = (result & COP_CLL_LONG) != 0; length = COP_CLL_LENGTH(result); if (length == 0) return 0; this->nconnections = length; this->connections = malloc(sizeof(nid_t) * (length + 3), M_DEVBUF, M_NOWAIT); if (this->connections == NULL) { printf("%s: out of memory\n", XNAME(codec->az)); return ENOMEM; } if (longform) { for (i = 0; i < length;) { err = codec->comresp(codec, this->nid, CORB_GET_CONNECTION_LIST_ENTRY, i, &result); if (err) return err; this->connections[i++] = CORB_CLE_LONG_0(result); this->connections[i++] = CORB_CLE_LONG_1(result); } } else { for (i = 0; i < length;) { err = codec->comresp(codec, this->nid, CORB_GET_CONNECTION_LIST_ENTRY, i, &result); if (err) return err; this->connections[i++] = CORB_CLE_SHORT_0(result); this->connections[i++] = CORB_CLE_SHORT_1(result); this->connections[i++] = CORB_CLE_SHORT_2(result); this->connections[i++] = CORB_CLE_SHORT_3(result); } } if (length > 0) { err = codec->comresp(codec, this->nid, CORB_GET_CONNECTION_SELECT_CONTROL, 0, &result); if (err) return err; this->selected = CORB_CSC_INDEX(result); } return 0; } int azalia_widget_check_conn(codec_t *codec, int index, int depth) { const widget_t *w; int i; w = &codec->w[index]; if (depth > 0 && (w->type == COP_AWTYPE_PIN_COMPLEX || w->type == COP_AWTYPE_AUDIO_OUTPUT || w->type == COP_AWTYPE_AUDIO_INPUT)) { if (w->enable) return 1; else return 0; } if (++depth >= 10) return 0; for (i = 0; i < w->nconnections; i++) { if (!azalia_widget_enabled(codec, w->connections[i])) continue; if (azalia_widget_check_conn(codec, w->connections[i], depth)) return 1; } return 0; } #ifdef AZALIA_DEBUG #define WIDGETCAP_BITS \ "\20\014LRSWAP\013POWER\012DIGITAL" \ "\011CONNLIST\010UNSOL\07PROC\06STRIPE\05FORMATOV\04AMPOV\03OUTAMP" \ "\02INAMP\01STEREO" #define PINCAP_BITS "\20\021EAPD\16VREF100\15VREF80" \ "\13VREFGND\12VREF50\11VREFHIZ\07BALANCE\06INPUT" \ "\05OUTPUT\04HEADPHONE\03PRESENCE\02TRIGGER\01IMPEDANCE" #define ENCODING_BITS "\20\3AC3\2FLOAT32\1PCM" #define BITSRATES_BITS "\20\x15""32bit\x14""24bit\x13""20bit" \ "\x12""16bit\x11""8bit""\x0c""384kHz\x0b""192kHz\x0a""176.4kHz" \ "\x09""96kHz\x08""88.2kHz\x07""48kHz\x06""44.1kHz\x05""32kHz\x04" \ "22.05kHz\x03""16kHz\x02""11.025kHz\x01""8kHz" static const char *pin_colors[16] = { "unknown", "black", "gray", "blue", "green", "red", "orange", "yellow", "purple", "pink", "col0a", "col0b", "col0c", "col0d", "white", "other"}; static const char *pin_conn[4] = { "jack", "none", "fixed", "combined"}; static const char *pin_conntype[16] = { "unknown", "1/8", "1/4", "atapi", "rca", "optical", "digital", "analog", "din", "xlr", "rj-11", "combination", "con0c", "con0d", "con0e", "other"}; static const char *pin_geo[15] = { "n/a", "rear", "front", "left", "right", "top", "bottom", "spec0", "spec1", "spec2", "loc0a", "loc0b", "loc0c", "loc0d", "loc0f"}; static const char *pin_chass[4] = { "external", "internal", "separate", "other"}; void azalia_codec_print_audiofunc(const codec_t *this) { uint32_t result; azalia_widget_print_audio(&this->w[this->audiofunc], "\t"); result = this->w[this->audiofunc].inamp_cap; DPRINTF(("\tinamp: mute=%u size=%u steps=%u offset=%u\n", (result & COP_AMPCAP_MUTE) != 0, COP_AMPCAP_STEPSIZE(result), COP_AMPCAP_NUMSTEPS(result), COP_AMPCAP_OFFSET(result))); result = this->w[this->audiofunc].outamp_cap; DPRINTF(("\toutamp: mute=%u size=%u steps=%u offset=%u\n", (result & COP_AMPCAP_MUTE) != 0, COP_AMPCAP_STEPSIZE(result), COP_AMPCAP_NUMSTEPS(result), COP_AMPCAP_OFFSET(result))); this->comresp(this, this->audiofunc, CORB_GET_PARAMETER, COP_GPIO_COUNT, &result); DPRINTF(("\tgpio: wake=%u unsol=%u gpis=%u gpos=%u gpios=%u\n", (result & COP_GPIO_WAKE) != 0, (result & COP_GPIO_UNSOL) != 0, COP_GPIO_GPIS(result), COP_GPIO_GPOS(result), COP_GPIO_GPIOS(result))); } void azalia_codec_print_groups(const codec_t *this) { int i, n; for (i = 0; i < this->dacs.ngroups; i++) { printf("%s: dacgroup[%d]:", XNAME(this->az), i); for (n = 0; n < this->dacs.groups[i].nconv; n++) { printf(" %2.2x", this->dacs.groups[i].conv[n]); } printf("\n"); } for (i = 0; i < this->adcs.ngroups; i++) { printf("%s: adcgroup[%d]:", XNAME(this->az), i); for (n = 0; n < this->adcs.groups[i].nconv; n++) { printf(" %2.2x", this->adcs.groups[i].conv[n]); } printf("\n"); } } void azalia_widget_print_audio(const widget_t *this, const char *lead) { printf("%sencodings=%b\n", lead, this->d.audio.encodings, ENCODING_BITS); printf("%sPCM formats=%b\n", lead, this->d.audio.bits_rates, BITSRATES_BITS); } void azalia_widget_print_widget(const widget_t *w, const codec_t *codec) { int i; printf("%s: ", XNAME(codec->az)); printf("%s%2.2x wcap=%b\n", w->type == COP_AWTYPE_PIN_COMPLEX ? pin_colors[w->d.pin.color] : wtypes[w->type], w->nid, w->widgetcap, WIDGETCAP_BITS); if (w->widgetcap & COP_AWCAP_FORMATOV) azalia_widget_print_audio(w, "\t"); if (w->type == COP_AWTYPE_PIN_COMPLEX) azalia_widget_print_pin(w); if (w->type == COP_AWTYPE_VOLUME_KNOB) printf("\tdelta=%d steps=%d\n", !!(w->d.volume.cap & COP_VKCAP_DELTA), COP_VKCAP_NUMSTEPS(w->d.volume.cap)); if ((w->widgetcap & COP_AWCAP_INAMP) && (w->widgetcap & COP_AWCAP_AMPOV)) printf("\tinamp: mute=%u size=%u steps=%u offset=%u\n", (w->inamp_cap & COP_AMPCAP_MUTE) != 0, COP_AMPCAP_STEPSIZE(w->inamp_cap), COP_AMPCAP_NUMSTEPS(w->inamp_cap), COP_AMPCAP_OFFSET(w->inamp_cap)); if ((w->widgetcap & COP_AWCAP_OUTAMP) && (w->widgetcap & COP_AWCAP_AMPOV)) printf("\toutamp: mute=%u size=%u steps=%u offset=%u\n", (w->outamp_cap & COP_AMPCAP_MUTE) != 0, COP_AMPCAP_STEPSIZE(w->outamp_cap), COP_AMPCAP_NUMSTEPS(w->outamp_cap), COP_AMPCAP_OFFSET(w->outamp_cap)); if (w->nconnections > 0) { printf("\tconnections=0x%x", w->connections[0]); for (i = 1; i < w->nconnections; i++) printf(",0x%x", w->connections[i]); printf("; selected=0x%x\n", w->connections[w->selected]); } } void azalia_widget_print_pin(const widget_t *this) { printf("\tcap=%b\n", this->d.pin.cap, PINCAP_BITS); printf("\t[%2.2d/%2.2d] ", CORB_CD_ASSOCIATION(this->d.pin.config), CORB_CD_SEQUENCE(this->d.pin.config)); printf("color=%s ", pin_colors[CORB_CD_COLOR(this->d.pin.config)]); printf("device=%s ", pin_devices[CORB_CD_DEVICE(this->d.pin.config)]); printf("conn=%s ", pin_conn[CORB_CD_PORT(this->d.pin.config)]); printf("conntype=%s\n", pin_conntype[CORB_CD_CONNECTION(this->d.pin.config)]); printf("\tlocation=%s ", pin_geo[CORB_CD_LOC_GEO(this->d.pin.config)]); printf("chassis=%s ", pin_chass[CORB_CD_LOC_CHASS(this->d.pin.config)]); printf("special="); if (CORB_CD_LOC_GEO(this->d.pin.config) == CORB_CD_LOC_SPEC0) { if (CORB_CD_LOC_CHASS(this->d.pin.config) == CORB_CD_EXTERNAL) printf("rear-panel"); else if (CORB_CD_LOC_CHASS(this->d.pin.config) == CORB_CD_INTERNAL) printf("riser"); else if (CORB_CD_LOC_CHASS(this->d.pin.config) == CORB_CD_LOC_OTHER) printf("mobile-lid-internal"); } else if (CORB_CD_LOC_GEO(this->d.pin.config) == CORB_CD_LOC_SPEC1) { if (CORB_CD_LOC_CHASS(this->d.pin.config) == CORB_CD_EXTERNAL) printf("drive-bay"); else if (CORB_CD_LOC_CHASS(this->d.pin.config) == CORB_CD_INTERNAL) printf("hdmi"); else if (CORB_CD_LOC_CHASS(this->d.pin.config) == CORB_CD_LOC_OTHER) printf("mobile-lid-external"); } else if (CORB_CD_LOC_GEO(this->d.pin.config) == CORB_CD_LOC_SPEC2) { if (CORB_CD_LOC_CHASS(this->d.pin.config) == CORB_CD_INTERNAL) printf("atapi"); } else printf("none"); printf("\n"); } #else /* AZALIA_DEBUG */ void azalia_codec_print_audiofunc(const codec_t *this) {} void azalia_codec_print_groups(const codec_t *this) {} void azalia_widget_print_audio(const widget_t *this, const char *lead) {} void azalia_widget_print_widget(const widget_t *w, const codec_t *codec) {} void azalia_widget_print_pin(const widget_t *this) {} #endif /* AZALIA_DEBUG */ /* ================================================================ * Stream functions * ================================================================ */ int azalia_stream_init(stream_t *this, azalia_t *az, int regindex, int strnum, int dir) { int err; this->az = az; this->regbase = HDA_SD_BASE + regindex * HDA_SD_SIZE; this->intr_bit = 1 << regindex; this->number = strnum; this->dir = dir; /* setup BDL buffers */ err = azalia_alloc_dmamem(az, sizeof(bdlist_entry_t) * HDA_BDL_MAX, 128, &this->bdlist); if (err) { printf("%s: can't allocate a BDL buffer\n", XNAME(az)); return err; } return 0; } int azalia_stream_delete(stream_t *this, azalia_t *az) { if (this->bdlist.addr == NULL) return 0; /* disable stream interrupts */ STR_WRITE_1(this, CTL, STR_READ_1(this, CTL) | ~(HDA_SD_CTL_DEIE | HDA_SD_CTL_FEIE | HDA_SD_CTL_IOCE)); azalia_free_dmamem(az, &this->bdlist); return 0; } int azalia_stream_reset(stream_t *this) { int i; uint16_t ctl; uint8_t sts; /* Make sure RUN bit is zero before resetting */ ctl = STR_READ_2(this, CTL); ctl &= ~HDA_SD_CTL_RUN; STR_WRITE_2(this, CTL, ctl); DELAY(40); /* Start reset and wait for chip to enter. */ ctl = STR_READ_2(this, CTL); STR_WRITE_2(this, CTL, ctl | HDA_SD_CTL_SRST); for (i = 5000; i >= 0; i--) { DELAY(10); ctl = STR_READ_2(this, CTL); if (ctl & HDA_SD_CTL_SRST) break; } if (i <= 0) { printf("%s: stream reset failure 1\n", XNAME(this->az)); return -1; } /* Clear reset and wait for chip to finish */ STR_WRITE_2(this, CTL, ctl & ~HDA_SD_CTL_SRST); for (i = 5000; i >= 0; i--) { DELAY(10); ctl = STR_READ_2(this, CTL); if ((ctl & HDA_SD_CTL_SRST) == 0) break; } if (i <= 0) { printf("%s: stream reset failure 2\n", XNAME(this->az)); return -1; } sts = STR_READ_1(this, STS); sts |= HDA_SD_STS_DESE | HDA_SD_STS_FIFOE | HDA_SD_STS_BCIS; STR_WRITE_1(this, STS, sts); return (0); } int azalia_stream_start(stream_t *this, void *start, void *end, int blk, void (*intr)(void *), void *arg, uint16_t fmt) { bdlist_entry_t *bdlist; bus_addr_t dmaaddr, dmaend; int err, index; uint32_t intctl; uint8_t ctl2; this->intr = intr; this->intr_arg = arg; err = azalia_stream_reset(this); if (err) { printf("%s: stream reset failed\n", "azalia"); return err; } STR_WRITE_4(this, BDPL, 0); STR_WRITE_4(this, BDPU, 0); /* setup BDL */ dmaaddr = AZALIA_DMA_DMAADDR(&this->buffer); dmaend = dmaaddr + ((caddr_t)end - (caddr_t)start); bdlist = (bdlist_entry_t*)this->bdlist.addr; for (index = 0; index < HDA_BDL_MAX; index++) { bdlist[index].low = htole32(dmaaddr); bdlist[index].high = htole32(PTR_UPPER32(dmaaddr)); bdlist[index].length = htole32(blk); bdlist[index].flags = htole32(BDLIST_ENTRY_IOC); dmaaddr += blk; if (dmaaddr >= dmaend) { index++; break; } } dmaaddr = AZALIA_DMA_DMAADDR(&this->bdlist); STR_WRITE_4(this, BDPL, dmaaddr); STR_WRITE_4(this, BDPU, PTR_UPPER32(dmaaddr)); STR_WRITE_2(this, LVI, (index - 1) & HDA_SD_LVI_LVI); ctl2 = STR_READ_1(this, CTL2); STR_WRITE_1(this, CTL2, (ctl2 & ~HDA_SD_CTL2_STRM) | (this->number << HDA_SD_CTL2_STRM_SHIFT)); STR_WRITE_4(this, CBL, ((caddr_t)end - (caddr_t)start)); STR_WRITE_2(this, FMT, fmt); err = azalia_codec_connect_stream(&this->az->codecs[this->az->codecno], this->dir, fmt, this->number); if (err) return EINVAL; intctl = AZ_READ_4(this->az, INTCTL); intctl |= this->intr_bit; AZ_WRITE_4(this->az, INTCTL, intctl); STR_WRITE_1(this, CTL, STR_READ_1(this, CTL) | HDA_SD_CTL_DEIE | HDA_SD_CTL_FEIE | HDA_SD_CTL_IOCE | HDA_SD_CTL_RUN); return (0); } int azalia_stream_halt(stream_t *this) { uint16_t ctl; ctl = STR_READ_2(this, CTL); ctl &= ~(HDA_SD_CTL_DEIE | HDA_SD_CTL_FEIE | HDA_SD_CTL_IOCE | HDA_SD_CTL_RUN); STR_WRITE_2(this, CTL, ctl); AZ_WRITE_4(this->az, INTCTL, AZ_READ_4(this->az, INTCTL) & ~this->intr_bit); azalia_codec_disconnect_stream (&this->az->codecs[this->az->codecno], this->dir); return (0); } #define HDA_SD_STS_BITS "\20\3BCIS\4FIFOE\5DESE\6FIFORDY" int azalia_stream_intr(stream_t *this, uint32_t intsts) { u_int8_t sts; if ((intsts & this->intr_bit) == 0) return (0); sts = STR_READ_1(this, STS); STR_WRITE_1(this, STS, sts | HDA_SD_STS_DESE | HDA_SD_STS_FIFOE | HDA_SD_STS_BCIS); if (sts & (HDA_SD_STS_DESE | HDA_SD_STS_FIFOE)) printf("%s: stream %d: sts=%b\n", XNAME(this->az), this->number, sts, HDA_SD_STS_BITS); if (sts & HDA_SD_STS_BCIS) this->intr(this->intr_arg); return (1); } /* ================================================================ * MI audio entries * ================================================================ */ int azalia_open(void *v, int flags) { azalia_t *az; codec_t *codec; DPRINTFN(1, ("%s: flags=0x%x\n", __func__, flags)); az = v; codec = &az->codecs[az->codecno]; codec->running++; return 0; } void azalia_close(void *v) { azalia_t *az; codec_t *codec; DPRINTFN(1, ("%s\n", __func__)); az = v; codec = &az->codecs[az->codecno]; codec->running--; } int azalia_query_encoding(void *v, audio_encoding_t *enc) { azalia_t *az; codec_t *codec; az = v; codec = &az->codecs[az->codecno]; if (enc->index >= codec->nencs) return (EINVAL); *enc = codec->encs[enc->index]; return (0); } void azalia_get_default_params(void *addr, int mode, struct audio_params *params) { params->sample_rate = 48000; params->encoding = AUDIO_ENCODING_SLINEAR_LE; params->precision = 16; params->channels = 2; params->sw_code = NULL; params->factor = 1; } int azalia_match_format(codec_t *codec, int mode, audio_params_t *par) { int i; for (i = 0; i < codec->nformats; i++) { if (mode != codec->formats[i].mode) continue; if (par->encoding != codec->formats[i].encoding) continue; if (par->precision != codec->formats[i].precision) continue; if (par->channels != codec->formats[i].channels) continue; break; } return (i); } int azalia_set_params_sub(codec_t *codec, int mode, audio_params_t *par) { void (*swcode)(void *, u_char *, int) = NULL; char *cmode; int i, j; uint ochan, oenc, opre; if (mode == AUMODE_PLAY) cmode = "play"; else cmode = "record"; ochan = par->channels; oenc = par->encoding; opre = par->precision; if ((mode == AUMODE_PLAY && codec->dacs.ngroups == 0) || (mode == AUMODE_RECORD && codec->adcs.ngroups == 0)) { azalia_get_default_params(NULL, mode, par); return 0; } i = azalia_match_format(codec, mode, par); if (i == codec->nformats && par->channels == 1) { /* find a 2 channel format and emulate mono */ par->channels = 2; i = azalia_match_format(codec, mode, par); if (i != codec->nformats) { par->factor = 2; if (mode == AUMODE_RECORD) swcode = linear16_decimator; else swcode = noswap_bytes_mts; par->channels = 1; } } par->channels = ochan; if (i == codec->nformats && (par->precision != 16 || par->encoding != AUDIO_ENCODING_SLINEAR_LE)) { /* try with default encoding/precision */ par->encoding = AUDIO_ENCODING_SLINEAR_LE; par->precision = 16; i = azalia_match_format(codec, mode, par); } if (i == codec->nformats && par->channels == 1) { /* find a 2 channel format and emulate mono */ par->channels = 2; i = azalia_match_format(codec, mode, par); if (i != codec->nformats) { par->factor = 2; if (mode == AUMODE_RECORD) swcode = linear16_decimator; else swcode = noswap_bytes_mts; par->channels = 1; } } par->channels = ochan; if (i == codec->nformats && par->channels != 2) { /* try with default channels */ par->encoding = oenc; par->precision = opre; par->channels = 2; i = azalia_match_format(codec, mode, par); } /* try with default everything */ if (i == codec->nformats) { par->encoding = AUDIO_ENCODING_SLINEAR_LE; par->precision = 16; par->channels = 2; i = azalia_match_format(codec, mode, par); if (i == codec->nformats) { DPRINTF(("%s: can't find %s format %u/%u/%u\n", __func__, cmode, par->encoding, par->precision, par->channels)); return EINVAL; } } if (codec->formats[i].frequency_type == 0) { DPRINTF(("%s: matched %s format %d has 0 frequencies\n", __func__, cmode, i)); return EINVAL; } for (j = 0; j < codec->formats[i].frequency_type; j++) { if (par->sample_rate != codec->formats[i].frequency[j]) continue; break; } if (j == codec->formats[i].frequency_type) { /* try again with default */ par->sample_rate = 48000; for (j = 0; j < codec->formats[i].frequency_type; j++) { if (par->sample_rate != codec->formats[i].frequency[j]) continue; break; } if (j == codec->formats[i].frequency_type) { DPRINTF(("%s: can't find %s rate %u\n", __func__, cmode, par->sample_rate)); return EINVAL; } } par->sw_code = swcode; return (0); } int azalia_set_params(void *v, int smode, int umode, audio_params_t *p, audio_params_t *r) { azalia_t *az; codec_t *codec; int ret; az = v; codec = &az->codecs[az->codecno]; if (codec->nformats == 0) { DPRINTF(("%s: codec has no formats\n", __func__)); return EINVAL; } if (smode & AUMODE_RECORD && r != NULL) { ret = azalia_set_params_sub(codec, AUMODE_RECORD, r); if (ret) return (ret); } if (smode & AUMODE_PLAY && p != NULL) { ret = azalia_set_params_sub(codec, AUMODE_PLAY, p); if (ret) return (ret); } return (0); } int azalia_round_blocksize(void *v, int blk) { azalia_t *az; size_t size; blk &= ~0x7f; /* must be multiple of 128 */ if (blk <= 0) blk = 128; /* number of blocks must be <= HDA_BDL_MAX */ az = v; size = az->pstream.buffer.size; #ifdef DIAGNOSTIC if (size <= 0) { printf("%s: size is 0", __func__); return 256; } #endif if (size > HDA_BDL_MAX * blk) { blk = size / HDA_BDL_MAX; if (blk & 0x7f) blk = (blk + 0x7f) & ~0x7f; } DPRINTFN(1,("%s: resultant block size = %d\n", __func__, blk)); return blk; } int azalia_halt_output(void *v) { azalia_t *az; DPRINTFN(1, ("%s\n", __func__)); az = v; return azalia_stream_halt(&az->pstream); } int azalia_halt_input(void *v) { azalia_t *az; DPRINTFN(1, ("%s\n", __func__)); az = v; return azalia_stream_halt(&az->rstream); } int azalia_getdev(void *v, struct audio_device *dev) { azalia_t *az; az = v; strlcpy(dev->name, "HD-Audio", MAX_AUDIO_DEV_LEN); snprintf(dev->version, MAX_AUDIO_DEV_LEN, "%d.%d", AZ_READ_1(az, VMAJ), AZ_READ_1(az, VMIN)); strlcpy(dev->config, XNAME(az), MAX_AUDIO_DEV_LEN); return 0; } int azalia_set_port(void *v, mixer_ctrl_t *mc) { azalia_t *az; codec_t *co; az = v; co = &az->codecs[az->codecno]; if (mc->dev < 0 || mc->dev >= co->nmixers) return EINVAL; return co->set_port(co, mc); } int azalia_get_port(void *v, mixer_ctrl_t *mc) { azalia_t *az; codec_t *co; az = v; co = &az->codecs[az->codecno]; if (mc->dev < 0 || mc->dev >= co->nmixers) return EINVAL; return co->get_port(co, mc); } int azalia_query_devinfo(void *v, mixer_devinfo_t *mdev) { azalia_t *az; const codec_t *co; az = v; co = &az->codecs[az->codecno]; if (mdev->index < 0 || mdev->index >= co->nmixers) return ENXIO; *mdev = co->mixers[mdev->index].devinfo; return 0; } void * azalia_allocm(void *v, int dir, size_t size, int pool, int flags) { azalia_t *az; stream_t *stream; int err; az = v; stream = dir == AUMODE_PLAY ? &az->pstream : &az->rstream; err = azalia_alloc_dmamem(az, size, 128, &stream->buffer); if (err) { printf("%s: allocm failed\n", az->dev.dv_xname); return NULL; } return stream->buffer.addr; } void azalia_freem(void *v, void *addr, int pool) { azalia_t *az; stream_t *stream; az = v; if (addr == az->pstream.buffer.addr) { stream = &az->pstream; } else if (addr == az->rstream.buffer.addr) { stream = &az->rstream; } else { return; } azalia_free_dmamem(az, &stream->buffer); } size_t azalia_round_buffersize(void *v, int dir, size_t size) { size &= ~0x7f; /* must be multiple of 128 */ if (size <= 0) size = 128; return size; } int azalia_get_props(void *v) { return AUDIO_PROP_INDEPENDENT | AUDIO_PROP_FULLDUPLEX; } int azalia_trigger_output(void *v, void *start, void *end, int blk, void (*intr)(void *), void *arg, audio_params_t *param) { azalia_t *az; int err; uint16_t fmt; az = v; if (az->codecs[az->codecno].dacs.ngroups == 0) { DPRINTF(("%s: can't play without a DAC\n", __func__)); return ENXIO; } err = azalia_params2fmt(param, &fmt); if (err) return EINVAL; return azalia_stream_start(&az->pstream, start, end, blk, intr, arg, fmt); } int azalia_trigger_input(void *v, void *start, void *end, int blk, void (*intr)(void *), void *arg, audio_params_t *param) { azalia_t *az; int err; uint16_t fmt; DPRINTFN(1, ("%s: this=%p start=%p end=%p blk=%d {enc=%u %uch %ubit %uHz}\n", __func__, v, start, end, blk, param->encoding, param->channels, param->precision, param->sample_rate)); az = v; if (az->codecs[az->codecno].adcs.ngroups == 0) { DPRINTF(("%s: can't record without an ADC\n", __func__)); return ENXIO; } err = azalia_params2fmt(param, &fmt); if (err) return EINVAL; return azalia_stream_start(&az->rstream, start, end, blk, intr, arg, fmt); } /* -------------------------------- * helpers for MI audio functions * -------------------------------- */ int azalia_params2fmt(const audio_params_t *param, uint16_t *fmt) { uint16_t ret; ret = 0; if (param->channels > HDA_MAX_CHANNELS) { printf("%s: too many channels: %u\n", __func__, param->channels); return EINVAL; } /* Only mono is emulated, and it is emulated from stereo. */ if (param->sw_code != NULL) ret |= 1; else ret |= param->channels - 1; switch (param->precision) { case 8: ret |= HDA_SD_FMT_BITS_8_16; break; case 16: ret |= HDA_SD_FMT_BITS_16_16; break; case 32: ret |= HDA_SD_FMT_BITS_32_32; break; } #if 0 switch (param->validbits) { case 8: ret |= HDA_SD_FMT_BITS_8_16; break; case 16: ret |= HDA_SD_FMT_BITS_16_16; break; case 20: ret |= HDA_SD_FMT_BITS_20_32; break; case 24: ret |= HDA_SD_FMT_BITS_24_32; break; case 32: ret |= HDA_SD_FMT_BITS_32_32; break; default: printf("%s: invalid validbits: %u\n", __func__, param->validbits); } #endif if (param->sample_rate == 384000) { printf("%s: invalid sample_rate: %u\n", __func__, param->sample_rate); return EINVAL; } else if (param->sample_rate == 192000) { ret |= HDA_SD_FMT_BASE_48 | HDA_SD_FMT_MULT_X4 | HDA_SD_FMT_DIV_BY1; } else if (param->sample_rate == 176400) { ret |= HDA_SD_FMT_BASE_44 | HDA_SD_FMT_MULT_X4 | HDA_SD_FMT_DIV_BY1; } else if (param->sample_rate == 96000) { ret |= HDA_SD_FMT_BASE_48 | HDA_SD_FMT_MULT_X2 | HDA_SD_FMT_DIV_BY1; } else if (param->sample_rate == 88200) { ret |= HDA_SD_FMT_BASE_44 | HDA_SD_FMT_MULT_X2 | HDA_SD_FMT_DIV_BY1; } else if (param->sample_rate == 48000) { ret |= HDA_SD_FMT_BASE_48 | HDA_SD_FMT_MULT_X1 | HDA_SD_FMT_DIV_BY1; } else if (param->sample_rate == 44100) { ret |= HDA_SD_FMT_BASE_44 | HDA_SD_FMT_MULT_X1 | HDA_SD_FMT_DIV_BY1; } else if (param->sample_rate == 32000) { ret |= HDA_SD_FMT_BASE_48 | HDA_SD_FMT_MULT_X2 | HDA_SD_FMT_DIV_BY3; } else if (param->sample_rate == 22050) { ret |= HDA_SD_FMT_BASE_44 | HDA_SD_FMT_MULT_X1 | HDA_SD_FMT_DIV_BY2; } else if (param->sample_rate == 16000) { ret |= HDA_SD_FMT_BASE_48 | HDA_SD_FMT_MULT_X1 | HDA_SD_FMT_DIV_BY3; } else if (param->sample_rate == 11025) { ret |= HDA_SD_FMT_BASE_44 | HDA_SD_FMT_MULT_X1 | HDA_SD_FMT_DIV_BY4; } else if (param->sample_rate == 8000) { ret |= HDA_SD_FMT_BASE_48 | HDA_SD_FMT_MULT_X1 | HDA_SD_FMT_DIV_BY6; } else { printf("%s: invalid sample_rate: %u\n", __func__, param->sample_rate); return EINVAL; } *fmt = ret; return 0; } int azalia_create_encodings(codec_t *this) { struct audio_format f; int encs[16]; int enc, nencs; int i, j; nencs = 0; for (i = 0; i < this->nformats && nencs < 16; i++) { f = this->formats[i]; if (f.validbits != f.precision) continue; enc = f.precision << 8 | f.encoding; for (j = 0; j < nencs; j++) { if (encs[j] == enc) break; } if (j < nencs) continue; encs[j] = enc; nencs++; } if (this->encs != NULL) free(this->encs, M_DEVBUF); this->nencs = 0; this->encs = malloc(sizeof(struct audio_encoding) * nencs, M_DEVBUF, M_NOWAIT | M_ZERO); if (this->encs == NULL) { printf("%s: out of memory in %s\n", XNAME(this->az), __func__); return ENOMEM; } this->nencs = nencs; for (i = 0; i < this->nencs; i++) { this->encs[i].index = i; this->encs[i].encoding = encs[i] & 0xff; this->encs[i].precision = encs[i] >> 8; this->encs[i].flags = 0; switch (this->encs[i].encoding) { case AUDIO_ENCODING_SLINEAR_LE: strlcpy(this->encs[i].name, this->encs[i].precision == 8 ? AudioEslinear : AudioEslinear_le, sizeof this->encs[i].name); break; case AUDIO_ENCODING_ULINEAR_LE: strlcpy(this->encs[i].name, this->encs[i].precision == 8 ? AudioEulinear : AudioEulinear_le, sizeof this->encs[i].name); break; default: DPRINTF(("%s: unknown format\n", __func__)); break; } } return (0); }