Source-Changes-HG archive
[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index][Old Index]
[src/trunk]: src/sys/arch/arm/broadcom add wip videocore4 audio driver
details: https://anonhg.NetBSD.org/src/rev/a8810fc3136d
branches: trunk
changeset: 785676:a8810fc3136d
user: jmcneill <jmcneill%NetBSD.org@localhost>
date: Sun Mar 24 19:55:19 2013 +0000
description:
add wip videocore4 audio driver
diffstat:
sys/arch/arm/broadcom/bcm2835_vcaudio.c | 719 +++++++++++++++++++++++++++++
sys/arch/arm/broadcom/bcm2835_vcaudioreg.h | 158 ++++++
sys/arch/arm/broadcom/files.bcm2835 | 7 +-
3 files changed, 883 insertions(+), 1 deletions(-)
diffs (truncated from 903 to 300 lines):
diff -r 7ce385781f2f -r a8810fc3136d sys/arch/arm/broadcom/bcm2835_vcaudio.c
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/sys/arch/arm/broadcom/bcm2835_vcaudio.c Sun Mar 24 19:55:19 2013 +0000
@@ -0,0 +1,719 @@
+/* $NetBSD: bcm2835_vcaudio.c,v 1.1 2013/03/24 19:55:19 jmcneill Exp $ */
+
+/*-
+ * Copyright (c) 2013 Jared D. McNeill <jmcneill%invisible.ca@localhost>
+ * All rights reserved.
+ *
+ * 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.
+ */
+
+/*
+ * VideoCore audio interface
+ */
+
+#include <sys/cdefs.h>
+__KERNEL_RCSID(0, "$NetBSD: bcm2835_vcaudio.c,v 1.1 2013/03/24 19:55:19 jmcneill Exp $");
+
+#include <sys/param.h>
+#include <sys/types.h>
+#include <sys/systm.h>
+#include <sys/device.h>
+#include <sys/conf.h>
+#include <sys/bus.h>
+#include <sys/kmem.h>
+#include <sys/workqueue.h>
+
+#include <sys/audioio.h>
+#include <dev/audio_if.h>
+#include <dev/auconv.h>
+
+#include <interface/compat/vchi_bsd.h>
+#include <interface/vchiq_arm/vchiq_netbsd.h>
+#include <interface/vchi/vchi.h>
+
+#include "bcm2835_vcaudioreg.h"
+
+#define vol2pct(vol) (((vol) * 100) / 255)
+
+enum {
+ VCAUDIO_OUTPUT_CLASS,
+ VCAUDIO_INPUT_CLASS,
+ VCAUDIO_OUTPUT_MASTER_VOLUME,
+ VCAUDIO_INPUT_DAC_VOLUME,
+ VCAUDIO_ENUM_LAST,
+};
+
+enum vcaudio_dest {
+ VCAUDIO_DEST_AUTO = 0,
+ VCAUDIO_DEST_HP = 1,
+ VCAUDIO_DEST_HDMI = 2,
+};
+
+struct vcaudio_work {
+ struct work vw_wk;
+};
+
+struct vcaudio_softc {
+ device_t sc_dev;
+ device_t sc_audiodev;
+
+ kmutex_t sc_lock;
+ kmutex_t sc_intr_lock;
+ kcondvar_t sc_cv;
+
+ struct audio_format sc_format;
+ struct audio_encoding_set *sc_encodings;
+
+ void (*sc_pint)(void *);
+ void *sc_pintarg;
+ audio_params_t sc_pparam;
+ bool sc_started;
+ int sc_pbytes;
+ off_t sc_ppos;
+ void *sc_pstart;
+ void *sc_pend;
+ int sc_pblksize;
+
+ int sc_success;
+
+ VCHI_INSTANCE_T sc_instance;
+ VCHI_CONNECTION_T sc_connection;
+ VCHI_SERVICE_HANDLE_T sc_service;
+
+ struct workqueue *sc_wq;
+ struct vcaudio_work sc_work;
+
+ int sc_volume;
+ enum vcaudio_dest sc_dest;
+};
+
+static int vcaudio_match(device_t, cfdata_t, void *);
+static void vcaudio_attach(device_t, device_t, void *);
+static int vcaudio_rescan(device_t, const char *, const int *);
+static void vcaudio_childdet(device_t, device_t);
+
+static int vcaudio_init(struct vcaudio_softc *);
+static void vcaudio_service_callback(void *,
+ const VCHI_CALLBACK_REASON_T,
+ void *);
+static int vcaudio_msg_sync(struct vcaudio_softc *, VC_AUDIO_MSG_T *, size_t);
+static void vcaudio_worker(struct work *, void *);
+
+static int vcaudio_open(void *, int);
+static void vcaudio_close(void *);
+static int vcaudio_query_encoding(void *, struct audio_encoding *);
+static int vcaudio_set_params(void *, int, int,
+ audio_params_t *, audio_params_t *,
+ stream_filter_list_t *,
+ stream_filter_list_t *);
+static int vcaudio_halt_output(void *);
+static int vcaudio_halt_input(void *);
+static int vcaudio_set_port(void *, mixer_ctrl_t *);
+static int vcaudio_get_port(void *, mixer_ctrl_t *);
+static int vcaudio_query_devinfo(void *, mixer_devinfo_t *);
+static int vcaudio_getdev(void *, struct audio_device *);
+static int vcaudio_get_props(void *);
+static int vcaudio_round_blocksize(void *, int, int, const audio_params_t *);
+static size_t vcaudio_round_buffersize(void *, int, size_t);
+static int vcaudio_trigger_output(void *, void *, void *, int,
+ void (*)(void *), void *,
+ const audio_params_t *);
+static int vcaudio_trigger_input(void *, void *, void *, int,
+ void (*)(void *), void *,
+ const audio_params_t *);
+static void vcaudio_get_locks(void *, kmutex_t **, kmutex_t **);
+
+static const struct audio_hw_if vcaudio_hw_if = {
+ .open = vcaudio_open,
+ .close = vcaudio_close,
+ .query_encoding = vcaudio_query_encoding,
+ .set_params = vcaudio_set_params,
+ .halt_output = vcaudio_halt_output,
+ .halt_input = vcaudio_halt_input,
+ .getdev = vcaudio_getdev,
+ .set_port = vcaudio_set_port,
+ .get_port = vcaudio_get_port,
+ .query_devinfo = vcaudio_query_devinfo,
+ .get_props = vcaudio_get_props,
+ .round_blocksize = vcaudio_round_blocksize,
+ .round_buffersize = vcaudio_round_buffersize,
+ .trigger_output = vcaudio_trigger_output,
+ .trigger_input = vcaudio_trigger_input,
+ .get_locks = vcaudio_get_locks,
+};
+
+CFATTACH_DECL2_NEW(vcaudio, sizeof(struct vcaudio_softc),
+ vcaudio_match, vcaudio_attach, NULL, NULL, vcaudio_rescan, vcaudio_childdet);
+
+static int
+vcaudio_match(device_t parent, cfdata_t match, void *aux)
+{
+ struct vchiq_attach_args *vaa = aux;
+
+ return !strcmp(vaa->vaa_name, "AUDS");
+}
+
+static void
+vcaudio_attach(device_t parent, device_t self, void *aux)
+{
+ struct vcaudio_softc *sc = device_private(self);
+ int error;
+
+ sc->sc_dev = self;
+ mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE);
+ mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_SCHED);
+ cv_init(&sc->sc_cv, "vcaudiocv");
+ error = workqueue_create(&sc->sc_wq, "vcaudiowq", vcaudio_worker,
+ sc, PRI_BIO, IPL_SCHED, WQ_MPSAFE);
+ if (error) {
+ aprint_error(": couldn't create workqueue (%d)\n", error);
+ return;
+ }
+
+ aprint_naive("\n");
+ aprint_normal(": AUDS\n");
+
+ if (vcaudio_init(sc) != 0) {
+ aprint_error_dev(self, "not configured\n");
+ return;
+ }
+
+ vcaudio_rescan(self, NULL, NULL);
+}
+
+static int
+vcaudio_rescan(device_t self, const char *ifattr, const int *locs)
+{
+ struct vcaudio_softc *sc = device_private(self);
+
+ if (ifattr_match(ifattr, "audiobus") && sc->sc_audiodev == NULL) {
+ sc->sc_audiodev = audio_attach_mi(&vcaudio_hw_if,
+ sc, sc->sc_dev);
+ }
+ return 0;
+}
+
+static void
+vcaudio_childdet(device_t self, device_t child)
+{
+ struct vcaudio_softc *sc = device_private(self);
+
+ if (sc->sc_audiodev == child)
+ sc->sc_audiodev = NULL;
+}
+
+static int
+vcaudio_init(struct vcaudio_softc *sc)
+{
+ VC_AUDIO_MSG_T msg;
+ int error;
+
+ sc->sc_volume = 128;
+ sc->sc_dest = VCAUDIO_DEST_AUTO;
+
+ sc->sc_format.mode = AUMODE_PLAY|AUMODE_RECORD;
+ sc->sc_format.encoding = AUDIO_ENCODING_SLINEAR_LE;
+ sc->sc_format.validbits = 16;
+ sc->sc_format.precision = 16;
+ sc->sc_format.channels = 2;
+ sc->sc_format.channel_mask = AUFMT_STEREO;
+ sc->sc_format.frequency_type = 0;
+ sc->sc_format.frequency[0] = 8000;
+ sc->sc_format.frequency[1] = 48000;
+
+ error = auconv_create_encodings(&sc->sc_format, 1, &sc->sc_encodings);
+ if (error) {
+ aprint_error_dev(sc->sc_dev,
+ "couldn't create encodings (error=%d)\n", error);
+ return error;
+ }
+
+ error = vchi_initialise(&sc->sc_instance);
+ if (error) {
+ device_printf(sc->sc_dev, "couldn't init vchi instance (%d)\n",
+ error);
+ return EIO;
+ }
+
+ error = vchi_connect(NULL, 0, sc->sc_instance);
+ if (error) {
+ device_printf(sc->sc_dev, "couldn't connect vchi (%d)\n",
+ error);
+ return EIO;
+ }
+
+ SERVICE_CREATION_T setup = {
+ .version = VCHI_VERSION(VC_AUDIOSERV_VER),
+ .service_id = VC_AUDIO_SERVER_NAME,
+ .connection = &sc->sc_connection,
+ .rx_fifo_size = 0,
+ .tx_fifo_size = 0,
+ .callback = vcaudio_service_callback,
+ .callback_param = sc,
+ .want_unaligned_bulk_rx = 1,
+ .want_unaligned_bulk_tx = 1,
+ .want_crc = 0,
+ };
+
+ error = vchi_service_open(sc->sc_instance, &setup, &sc->sc_service);
+ if (error) {
+ device_printf(sc->sc_dev, "couldn't open service (%d)\n",
+ error);
+ return EIO;
+ }
+ vchi_service_release(sc->sc_service);
+
+ vchi_service_use(sc->sc_service);
+ memset(&msg, 0, sizeof(msg));
+ msg.type = VC_AUDIO_MSG_TYPE_OPEN;
+ error = vchi_msg_queue(sc->sc_service, &msg, sizeof(msg),
+ VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL);
+ if (error) {
+ device_printf(sc->sc_dev, "couldn't send OPEN message (%d)\n",
+ error);
+ }
+
+ memset(&msg, 0, sizeof(msg));
+ msg.type = VC_AUDIO_MSG_TYPE_CONTROL;
Home |
Main Index |
Thread Index |
Old Index