Skip site navigation (1)Skip section navigation (2)
Date:      Sat, 6 Nov 2021 17:49:52 GMT
From:      Andriy Gapon <avg@FreeBSD.org>
To:        src-committers@FreeBSD.org, dev-commits-src-all@FreeBSD.org, dev-commits-src-main@FreeBSD.org
Subject:   git: aa917184a9c0 - main - add rk3328_codec and rk_i2s from gonzoua/socaudio
Message-ID:  <202111061749.1A6HnqCP018142@gitrepo.freebsd.org>

next in thread | raw e-mail | index | archive | help
The branch main has been updated by avg:

URL: https://cgit.FreeBSD.org/src/commit/?id=aa917184a9c04b41e055e13b1ab158dfacca4c66

commit aa917184a9c04b41e055e13b1ab158dfacca4c66
Author:     Oleksandr Tymoshenko <gonzo@FreeBSD.org>
AuthorDate: 2021-06-04 12:18:06 +0000
Commit:     Andriy Gapon <avg@FreeBSD.org>
CommitDate: 2021-11-06 17:47:10 +0000

    add rk3328_codec and rk_i2s from gonzoua/socaudio
    
    Not sure why these haven't been committed with the rest of the SoC Audio
    project.  They work sufficiently well for me.
    
    Discussed with: manu
    MFC after:      1 month
---
 sys/arm64/rockchip/rk3328_codec.c | 593 ++++++++++++++++++++++++++++++++++
 sys/arm64/rockchip/rk_i2s.c       | 657 ++++++++++++++++++++++++++++++++++++++
 sys/conf/files.arm64              |   2 +
 3 files changed, 1252 insertions(+)

diff --git a/sys/arm64/rockchip/rk3328_codec.c b/sys/arm64/rockchip/rk3328_codec.c
new file mode 100644
index 000000000000..940b3b8bb9e8
--- /dev/null
+++ b/sys/arm64/rockchip/rk3328_codec.c
@@ -0,0 +1,593 @@
+/*-
+ * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
+ *
+ * Copyright (c) 2020 Oleksandr Tymoshenko <gonzo@FreeBSD.org>
+ * Copyright (c) 2018 Jared McNeill <jmcneill@invisible.ca>
+ *
+ * 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 AUTHOR ``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 AUTHOR 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.
+ *
+ * $FreeBSD$
+ */
+
+#include <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/bus.h>
+#include <sys/kernel.h>
+#include <sys/lock.h>
+#include <sys/module.h>
+#include <sys/mutex.h>
+#include <sys/rman.h>
+#include <sys/resource.h>
+#include <machine/bus.h>
+
+#include <dev/ofw/ofw_bus.h>
+#include <dev/ofw/ofw_bus_subr.h>
+
+#include <dev/extres/clk/clk.h>
+#include <dev/extres/syscon/syscon.h>
+
+#include "syscon_if.h"
+
+#include "opt_snd.h"
+#include <dev/sound/pcm/sound.h>
+#include <dev/sound/fdt/audio_dai.h>
+#include "audio_dai_if.h"
+#include "mixer_if.h"
+
+#define	RKCODEC_MIXER_DEVS		(1 << SOUND_MIXER_VOLUME)
+
+#define	GRF_SOC_CON2			0x0408
+#define	 SOC_CON2_I2S_ACODEC_EN			(1 << 14)
+#define	 SOC_CON2_I2S_ACODEC_EN_MASK		((1 << 14) << 16)
+#define	GRF_SOC_CON10			0x0428
+#define	 SOC_CON10_GPIOMUT			(1 << 1)
+#define	 SOC_CON10_GPIOMUT_MASK			((1 << 1) << 16)
+#define	 SOC_CON10_GPIOMUT_EN			(1 << 0)
+#define	 SOC_CON10_GPIOMUT_EN_MASK			((1 << 0) << 16)
+
+#define	CODEC_RESET			0x00
+#define	 RESET_DIG_CORE_RST			(1 << 1)
+#define	 RESET_SYS_RST				(1 << 0)
+#define	CODEC_DAC_INIT_CTRL1		0x0c
+#define	 DAC_INIT_CTRL1_DIRECTION_IN		(0 << 5)
+#define	 DAC_INIT_CTRL1_DIRECTION_OUT		(1 << 5)
+#define	 DAC_INIT_CTRL1_DAC_I2S_MODE_SLAVE	(0 << 4)
+#define	 DAC_INIT_CTRL1_DAC_I2S_MODE_MASTER	(1 << 4)
+#define	 DAC_INIT_CTRL1_MODE_MASK		(3 << 4)
+#define	CODEC_DAC_INIT_CTRL2		0x10
+#define	 DAC_INIT_CTRL2_DAC_VDL_16BITS		(0 << 5)
+#define	 DAC_INIT_CTRL2_DAC_VDL_20BITS		(1 << 5)
+#define	 DAC_INIT_CTRL2_DAC_VDL_24BITS		(2 << 5)
+#define	 DAC_INIT_CTRL2_DAC_VDL_32BITS		(3 << 5)
+#define	 DAC_INIT_CTRL2_DAC_VDL_MASK		(3 << 5)
+#define	 DAC_INIT_CTRL2_DAC_MODE_RJM		(0 << 3)
+#define	 DAC_INIT_CTRL2_DAC_MODE_LJM		(1 << 3)
+#define	 DAC_INIT_CTRL2_DAC_MODE_I2S		(2 << 3)
+#define	 DAC_INIT_CTRL2_DAC_MODE_PCM		(3 << 3)
+#define	 DAC_INIT_CTRL2_DAC_MODE_MASK		(3 << 3)
+#define	CODEC_DAC_INIT_CTRL3		0x14
+#define	 DAC_INIT_CTRL3_WL_16BITS		(0 << 2)
+#define	 DAC_INIT_CTRL3_WL_20BITS		(1 << 2)
+#define	 DAC_INIT_CTRL3_WL_24BITS		(2 << 2)
+#define	 DAC_INIT_CTRL3_WL_32BITS		(3 << 2)
+#define	 DAC_INIT_CTRL3_WL_MASK			(3 << 2)
+#define	 DAC_INIT_CTRL3_RST_MASK		(1 << 1)
+#define	 DAC_INIT_CTRL3_RST_DIS			(1 << 1)
+#define	 DAC_INIT_CTRL3_DAC_BCP_REVERSAL	(1 << 0)
+#define	 DAC_INIT_CTRL3_DAC_BCP_NORMAL		(0 << 0)
+#define	 DAC_INIT_CTRL3_DAC_BCP_MASK		(1 << 0)
+#define	CODEC_DAC_PRECHARGE_CTRL	0x88
+#define	 DAC_PRECHARGE_CTRL_DAC_CHARGE_PRECHARGE	(1 << 7)
+#define	 DAC_PRECHARGE_CTRL_DAC_CHARGE_CURRENT_I	(1 << 0)
+#define	 DAC_PRECHARGE_CTRL_DAC_CHARGE_CURRENT_ALL	(0x7f)
+#define	CODEC_DAC_PWR_CTRL		0x8c
+#define	 DAC_PWR_CTRL_DAC_PWR			(1 << 6)
+#define	 DAC_PWR_CTRL_DACL_PATH_REFV		(1 << 5)
+#define	 DAC_PWR_CTRL_HPOUTL_ZERO_CROSSING	(1 << 4)
+#define	 DAC_PWR_CTRL_DACR_PATH_REFV		(1 << 1)
+#define	 DAC_PWR_CTRL_HPOUTR_ZERO_CROSSING	(1 << 0)
+#define	CODEC_DAC_CLK_CTRL		0x90
+#define	 DAC_CLK_CTRL_DACL_REFV_ON		(1 << 7)
+#define	 DAC_CLK_CTRL_DACL_CLK_ON		(1 << 6)
+#define	 DAC_CLK_CTRL_DACL_ON			(1 << 5)
+#define	 DAC_CLK_CTRL_DACL_INIT_ON		(1 << 4)
+#define	 DAC_CLK_CTRL_DACR_REFV_ON		(1 << 3)
+#define	 DAC_CLK_CTRL_DACR_CLK_ON		(1 << 2)
+#define	 DAC_CLK_CTRL_DACR_ON			(1 << 1)
+#define	 DAC_CLK_CTRL_DACR_INIT_ON		(1 << 0)
+#define	CODEC_HPMIX_CTRL		0x94
+#define	 HPMIX_CTRL_HPMIXL_EN			(1 << 6)
+#define	 HPMIX_CTRL_HPMIXL_INIT_EN		(1 << 5)
+#define	 HPMIX_CTRL_HPMIXL_INIT2_EN		(1 << 4)
+#define	 HPMIX_CTRL_HPMIXR_EN			(1 << 2)
+#define	 HPMIX_CTRL_HPMIXR_INIT_EN		(1 << 1)
+#define	 HPMIX_CTRL_HPMIXR_INIT2_EN		(1 << 0)
+#define	CODEC_DAC_SELECT		0x98
+#define	 DAC_SELECT_DACL_SELECT			(1 << 4)
+#define	 DAC_SELECT_DACR_SELECT			(1 << 0)
+#define	CODEC_HPOUT_CTRL		0x9c
+#define	 HPOUT_CTRL_HPOUTL_EN			(1 << 7)
+#define	 HPOUT_CTRL_HPOUTL_INIT_EN		(1 << 6)
+#define	 HPOUT_CTRL_HPOUTL_UNMUTE		(1 << 5)
+#define	 HPOUT_CTRL_HPOUTR_EN			(1 << 4)
+#define	 HPOUT_CTRL_HPOUTR_INIT_EN		(1 << 3)
+#define	 HPOUT_CTRL_HPOUTR_UNMUTE		(1 << 2)
+#define	CODEC_HPOUTL_GAIN_CTRL		0xa0
+#define	CODEC_HPOUTR_GAIN_CTRL		0xa4
+#define	CODEC_HPOUT_POP_CTRL		0xa8
+#define	 HPOUT_POP_CTRL_HPOUTR_POP		(1 << 5)
+#define	 HPOUT_POP_CTRL_HPOUTR_POP_XCHARGE	(1 << 4)
+#define	 HPOUT_POP_CTRL_HPOUTL_POP		(1 << 1)
+#define	 HPOUT_POP_CTRL_HPOUTL_POP_XCHARGE	(1 << 0)
+
+#define	DEFAULT_RATE			(48000 * 256)
+
+static struct ofw_compat_data compat_data[] = {
+	{ "rockchip,rk3328-codec",	1},
+	{ NULL,				0 }
+};
+
+struct rkcodec_softc {
+	device_t	dev;
+	struct resource	*res;
+	struct mtx	mtx;
+	clk_t		mclk;
+	clk_t		pclk;
+	struct syscon	*grf;
+	u_int	regaddr;	/* address for the sysctl */
+};
+
+#define	RKCODEC_LOCK(sc)		mtx_lock(&(sc)->mtx)
+#define	RKCODEC_UNLOCK(sc)		mtx_unlock(&(sc)->mtx)
+#define	RKCODEC_READ(sc, reg)		bus_read_4((sc)->res, (reg))
+#define	RKCODEC_WRITE(sc, reg, val)	bus_write_4((sc)->res, (reg), (val))
+
+static int rkcodec_probe(device_t dev);
+static int rkcodec_attach(device_t dev);
+static int rkcodec_detach(device_t dev);
+
+static void
+rkcodec_set_power(struct rkcodec_softc *sc, bool poweron)
+{
+	uint32_t val;
+	val = RKCODEC_READ(sc, CODEC_DAC_PRECHARGE_CTRL);
+	if (poweron)
+		val |= DAC_PRECHARGE_CTRL_DAC_CHARGE_PRECHARGE;
+	else
+		val &= ~(DAC_PRECHARGE_CTRL_DAC_CHARGE_PRECHARGE);
+	RKCODEC_WRITE(sc, CODEC_DAC_PRECHARGE_CTRL, val);
+	DELAY(10);
+	if (poweron)
+		val |= DAC_PRECHARGE_CTRL_DAC_CHARGE_CURRENT_ALL;
+	else
+		val &= ~(DAC_PRECHARGE_CTRL_DAC_CHARGE_CURRENT_ALL);
+	RKCODEC_WRITE(sc, CODEC_DAC_PRECHARGE_CTRL, val);
+
+}
+
+static void
+rkcodec_set_mute(struct rkcodec_softc *sc, bool muted)
+{
+	uint32_t val;
+	val = SOC_CON10_GPIOMUT_MASK;
+	if (!muted)
+		val |= SOC_CON10_GPIOMUT;
+	SYSCON_WRITE_4(sc->grf, GRF_SOC_CON10, val);
+}
+
+static void
+rkcodec_reset(struct rkcodec_softc *sc)
+{
+
+	RKCODEC_WRITE(sc, CODEC_RESET, 0);
+	DELAY(10);
+	RKCODEC_WRITE(sc, CODEC_RESET, RESET_DIG_CORE_RST | RESET_SYS_RST);
+}
+
+static int
+rkcodec_probe(device_t dev)
+{
+	if (!ofw_bus_status_okay(dev))
+		return (ENXIO);
+
+	if (!ofw_bus_search_compatible(dev, compat_data)->ocd_data)
+		return (ENXIO);
+
+	device_set_desc(dev, "Rockchip RK3328 CODEC");
+	return (BUS_PROBE_DEFAULT);
+}
+
+static int
+rkcodec_attach(device_t dev)
+{
+	struct rkcodec_softc *sc;
+	int error, rid;
+	phandle_t node;
+	uint32_t val;
+
+	sc = device_get_softc(dev);
+	sc->dev = dev;
+
+	mtx_init(&sc->mtx, device_get_nameunit(dev), NULL, MTX_DEF);
+
+	rid = 0;
+	sc->res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid, RF_ACTIVE);
+	if (!sc->res) {
+		device_printf(dev, "could not allocate resource for device\n");
+		error = ENXIO;
+		goto fail;
+	}
+
+	node = ofw_bus_get_node(dev);
+	if (syscon_get_by_ofw_property(dev, node,
+	    "rockchip,grf", &sc->grf) != 0) {
+		device_printf(dev, "cannot get rockchip,grf handle\n");
+		return (ENXIO);
+	}
+
+	val = SOC_CON2_I2S_ACODEC_EN_MASK  | (SOC_CON2_I2S_ACODEC_EN << 16);
+	SYSCON_WRITE_4(sc->grf, GRF_SOC_CON2, val);
+
+	val = 0 | (SOC_CON10_GPIOMUT_EN << 16);
+	SYSCON_WRITE_4(sc->grf, GRF_SOC_CON10, val);
+
+	error = clk_get_by_ofw_name(dev, 0, "pclk", &sc->pclk);
+	if (error != 0) {
+		device_printf(dev, "could not get pclk clock\n");
+		goto fail;
+	}
+
+	error = clk_get_by_ofw_name(dev, 0, "mclk", &sc->mclk);
+	if (error != 0) {
+		device_printf(dev, "could not get mclk clock\n");
+		goto fail;
+	}
+
+	error = clk_enable(sc->pclk);
+	if (error != 0) {
+		device_printf(sc->dev, "could not enable pclk clock\n");
+		goto fail;
+	}
+
+	error = clk_enable(sc->mclk);
+	if (error != 0) {
+		device_printf(sc->dev, "could not enable mclk clock\n");
+		goto fail;
+	}
+
+#if 0
+	error = clk_set_freq(sc->mclk, DEFAULT_RATE, 0);
+	if (error != 0) {
+		device_printf(sc->dev, "could not set frequency for mclk clock\n");
+		goto fail;
+	}
+#endif
+
+	/* TODO: handle mute-gpios */
+
+	rkcodec_reset(sc);
+	rkcodec_set_power(sc, true);
+
+	val = RKCODEC_READ(sc, CODEC_DAC_PWR_CTRL);
+	val |= DAC_PWR_CTRL_DAC_PWR;
+	RKCODEC_WRITE(sc, CODEC_DAC_PWR_CTRL, val);
+
+	val |= DAC_PWR_CTRL_DACL_PATH_REFV |
+	    DAC_PWR_CTRL_DACR_PATH_REFV;
+	RKCODEC_WRITE(sc, CODEC_DAC_PWR_CTRL, val);
+
+	val |= DAC_PWR_CTRL_HPOUTL_ZERO_CROSSING |
+	    DAC_PWR_CTRL_HPOUTR_ZERO_CROSSING;
+	RKCODEC_WRITE(sc, CODEC_DAC_PWR_CTRL, val);
+
+	val = RKCODEC_READ(sc, CODEC_HPOUT_POP_CTRL);
+	val |= HPOUT_POP_CTRL_HPOUTR_POP | HPOUT_POP_CTRL_HPOUTL_POP;
+	val &= ~(HPOUT_POP_CTRL_HPOUTR_POP_XCHARGE | HPOUT_POP_CTRL_HPOUTL_POP_XCHARGE);
+	RKCODEC_WRITE(sc, CODEC_HPOUT_POP_CTRL, val);
+
+	val = RKCODEC_READ(sc, CODEC_HPMIX_CTRL);
+	val |= HPMIX_CTRL_HPMIXL_EN | HPMIX_CTRL_HPMIXR_EN;
+	RKCODEC_WRITE(sc, CODEC_HPMIX_CTRL, val);
+
+	val |= HPMIX_CTRL_HPMIXL_INIT_EN | HPMIX_CTRL_HPMIXR_INIT_EN;
+	RKCODEC_WRITE(sc, CODEC_HPMIX_CTRL, val);
+
+	val = RKCODEC_READ(sc, CODEC_HPOUT_CTRL);
+	val |= HPOUT_CTRL_HPOUTL_EN | HPOUT_CTRL_HPOUTR_EN;
+	RKCODEC_WRITE(sc, CODEC_HPOUT_CTRL, val);
+
+	val |= HPOUT_CTRL_HPOUTL_INIT_EN | HPOUT_CTRL_HPOUTR_INIT_EN;
+	RKCODEC_WRITE(sc, CODEC_HPOUT_CTRL, val);
+
+	val = RKCODEC_READ(sc, CODEC_DAC_CLK_CTRL);
+	val |= DAC_CLK_CTRL_DACL_REFV_ON | DAC_CLK_CTRL_DACR_REFV_ON;
+	RKCODEC_WRITE(sc, CODEC_DAC_CLK_CTRL, val);
+
+	val |= DAC_CLK_CTRL_DACL_CLK_ON | DAC_CLK_CTRL_DACR_CLK_ON;
+	RKCODEC_WRITE(sc, CODEC_DAC_CLK_CTRL, val);
+
+	val |= DAC_CLK_CTRL_DACL_ON | DAC_CLK_CTRL_DACR_ON;
+	RKCODEC_WRITE(sc, CODEC_DAC_CLK_CTRL, val);
+
+	val |= DAC_CLK_CTRL_DACL_INIT_ON | DAC_CLK_CTRL_DACR_INIT_ON;
+	RKCODEC_WRITE(sc, CODEC_DAC_CLK_CTRL, val);
+
+	val = RKCODEC_READ(sc, CODEC_DAC_SELECT);
+	val |= DAC_SELECT_DACL_SELECT | DAC_SELECT_DACR_SELECT;
+	RKCODEC_WRITE(sc, CODEC_DAC_SELECT, val);
+
+	val = RKCODEC_READ(sc, CODEC_HPMIX_CTRL);
+	val |= HPMIX_CTRL_HPMIXL_INIT2_EN | HPMIX_CTRL_HPMIXR_INIT2_EN;
+	RKCODEC_WRITE(sc, CODEC_HPMIX_CTRL, val);
+
+	val = RKCODEC_READ(sc, CODEC_HPOUT_CTRL);
+	val |= HPOUT_CTRL_HPOUTL_UNMUTE | HPOUT_CTRL_HPOUTR_UNMUTE;
+	RKCODEC_WRITE(sc, CODEC_HPOUT_CTRL, val);
+
+	RKCODEC_WRITE(sc, CODEC_HPOUTL_GAIN_CTRL, 0x1f);
+	RKCODEC_WRITE(sc, CODEC_HPOUTR_GAIN_CTRL, 0x1f);
+
+	rkcodec_set_mute(sc, false);
+
+	node = ofw_bus_get_node(dev);
+	OF_device_register_xref(OF_xref_from_node(node), dev);
+
+	return (0);
+
+fail:
+	rkcodec_detach(dev);
+	return (error);
+}
+
+static int
+rkcodec_detach(device_t dev)
+{
+	struct rkcodec_softc *sc;
+
+	sc = device_get_softc(dev);
+
+	if (sc->res)
+		bus_release_resource(dev, SYS_RES_MEMORY, 0, sc->res);
+	mtx_destroy(&sc->mtx);
+
+	return (0);
+}
+
+static int
+rkcodec_mixer_init(struct snd_mixer *m)
+{
+
+	mix_setdevs(m, RKCODEC_MIXER_DEVS);
+
+	return (0);
+}
+
+static int
+rkcodec_mixer_uninit(struct snd_mixer *m)
+{
+
+	return (0);
+}
+
+static int
+rkcodec_mixer_reinit(struct snd_mixer *m)
+{
+
+	return (0);
+}
+
+static int
+rkcodec_mixer_set(struct snd_mixer *m, unsigned dev, unsigned left, unsigned right)
+{
+	struct rkcodec_softc *sc;
+	struct mtx *mixer_lock;
+	uint8_t do_unlock;
+
+	sc = device_get_softc(mix_getdevinfo(m));
+	mixer_lock = mixer_get_lock(m);
+
+	if (mtx_owned(mixer_lock)) {
+		do_unlock = 0;
+	} else {
+		do_unlock = 1;
+		mtx_lock(mixer_lock);
+	}
+
+	right = left;
+
+	RKCODEC_LOCK(sc);
+	switch(dev) {
+	case SOUND_MIXER_VOLUME:
+		printf("[%s] %s:%d\n", __func__, __FILE__, __LINE__);
+		break;
+
+	case SOUND_MIXER_MIC:
+		printf("[%s] %s:%d\n", __func__, __FILE__, __LINE__);
+		break;
+	default:
+		break;
+	}
+	RKCODEC_UNLOCK(sc);
+
+	if (do_unlock) {
+		mtx_unlock(mixer_lock);
+	}
+
+	return (left | (right << 8));
+}
+
+static unsigned
+rkcodec_mixer_setrecsrc(struct snd_mixer *m, unsigned src)
+{
+
+	return (0);
+}
+
+static kobj_method_t rkcodec_mixer_methods[] = {
+	KOBJMETHOD(mixer_init,		rkcodec_mixer_init),
+	KOBJMETHOD(mixer_uninit,	rkcodec_mixer_uninit),
+	KOBJMETHOD(mixer_reinit,	rkcodec_mixer_reinit),
+	KOBJMETHOD(mixer_set,		rkcodec_mixer_set),
+	KOBJMETHOD(mixer_setrecsrc,	rkcodec_mixer_setrecsrc),
+	KOBJMETHOD_END
+};
+
+MIXER_DECLARE(rkcodec_mixer);
+
+static int
+rkcodec_dai_init(device_t dev, uint32_t format)
+{
+	struct rkcodec_softc *sc;
+	int fmt, pol, clk;
+	uint32_t ctrl1, ctrl2, ctrl3;
+
+	sc = device_get_softc(dev);
+
+	fmt = AUDIO_DAI_FORMAT_FORMAT(format);
+	pol = AUDIO_DAI_FORMAT_POLARITY(format);
+	clk = AUDIO_DAI_FORMAT_CLOCK(format);
+
+	ctrl1 = RKCODEC_READ(sc, CODEC_DAC_INIT_CTRL1);
+	ctrl2 = RKCODEC_READ(sc, CODEC_DAC_INIT_CTRL2);
+	ctrl3 = RKCODEC_READ(sc, CODEC_DAC_INIT_CTRL3);
+
+	ctrl3 &= ~(DAC_INIT_CTRL3_DAC_BCP_MASK);
+	switch (pol) {
+	case AUDIO_DAI_POLARITY_IB_NF:
+		ctrl3 |= DAC_INIT_CTRL3_DAC_BCP_REVERSAL;
+		break;
+	case AUDIO_DAI_POLARITY_NB_NF:
+		ctrl3 |= DAC_INIT_CTRL3_DAC_BCP_NORMAL;
+		break;
+	default:
+		return (EINVAL);
+	}
+
+	ctrl1 &= ~(DAC_INIT_CTRL1_MODE_MASK);
+	switch (clk) {
+	case AUDIO_DAI_CLOCK_CBM_CFM:
+		ctrl1 |= DAC_INIT_CTRL1_DIRECTION_OUT |
+		    DAC_INIT_CTRL1_DAC_I2S_MODE_SLAVE;
+		break;
+	case AUDIO_DAI_CLOCK_CBS_CFS:
+		ctrl1 |= DAC_INIT_CTRL1_DIRECTION_IN |
+		    DAC_INIT_CTRL1_DAC_I2S_MODE_SLAVE;
+		break;
+	default:
+		return (EINVAL);
+	}
+
+	ctrl2 &= ~(DAC_INIT_CTRL2_DAC_VDL_MASK | DAC_INIT_CTRL2_DAC_MODE_MASK);
+	ctrl2 |= DAC_INIT_CTRL2_DAC_VDL_16BITS;
+	ctrl3 &= ~(DAC_INIT_CTRL3_WL_MASK);
+	ctrl3 |= DAC_INIT_CTRL3_WL_32BITS;
+	switch (fmt) {
+	case AUDIO_DAI_FORMAT_I2S:
+		ctrl2 |= DAC_INIT_CTRL2_DAC_MODE_I2S;
+		break;
+	case AUDIO_DAI_FORMAT_LJ:
+		ctrl2 |= DAC_INIT_CTRL2_DAC_MODE_LJM;
+		break;
+	case AUDIO_DAI_FORMAT_RJ:
+		ctrl2 |= DAC_INIT_CTRL2_DAC_MODE_RJM;
+		break;
+	default:
+		return EINVAL;
+	}
+
+	ctrl3 &= ~(DAC_INIT_CTRL3_RST_MASK);
+	ctrl3 |= DAC_INIT_CTRL3_RST_DIS;
+
+	RKCODEC_WRITE(sc, CODEC_DAC_INIT_CTRL1, ctrl1);
+	RKCODEC_WRITE(sc, CODEC_DAC_INIT_CTRL2, ctrl2);
+	RKCODEC_WRITE(sc, CODEC_DAC_INIT_CTRL3, ctrl3);
+
+	return (0);
+}
+
+static int
+rkcodec_dai_trigger(device_t dev, int go, int pcm_dir)
+{
+	// struct rkcodec_softc 	*sc = device_get_softc(dev);
+
+	if ((pcm_dir != PCMDIR_PLAY) && (pcm_dir != PCMDIR_REC))
+		return (EINVAL);
+
+	switch (go) {
+	case PCMTRIG_START:
+		if (pcm_dir == PCMDIR_PLAY) {
+			printf("[%s] %s:%d\n", __func__, __FILE__, __LINE__);
+		}
+		else if (pcm_dir == PCMDIR_REC) {
+			printf("[%s] %s:%d\n", __func__, __FILE__, __LINE__);
+		}
+		break;
+
+	case PCMTRIG_STOP:
+	case PCMTRIG_ABORT:
+		if (pcm_dir == PCMDIR_PLAY) {
+			printf("[%s] %s:%d\n", __func__, __FILE__, __LINE__);
+		}
+		else if (pcm_dir == PCMDIR_REC) {
+			printf("[%s] %s:%d\n", __func__, __FILE__, __LINE__);
+		}
+		break;
+	}
+
+	return (0);
+}
+
+static int
+rkcodec_dai_setup_mixer(device_t dev, device_t pcmdev)
+{
+
+	mixer_init(pcmdev, &rkcodec_mixer_class, dev);
+
+	return (0);
+}
+
+static device_method_t rkcodec_methods[] = {
+	/* Device interface */
+	DEVMETHOD(device_probe,		rkcodec_probe),
+	DEVMETHOD(device_attach,	rkcodec_attach),
+	DEVMETHOD(device_detach,	rkcodec_detach),
+
+	DEVMETHOD(audio_dai_init,	rkcodec_dai_init),
+	DEVMETHOD(audio_dai_setup_mixer,	rkcodec_dai_setup_mixer),
+	DEVMETHOD(audio_dai_trigger,	rkcodec_dai_trigger),
+
+	DEVMETHOD_END
+};
+
+static driver_t rkcodec_driver = {
+	"rk3328codec",
+	rkcodec_methods,
+	sizeof(struct rkcodec_softc),
+};
+
+static devclass_t rkcodec_devclass;
+
+DRIVER_MODULE(rkcodec, simplebus, rkcodec_driver, rkcodec_devclass, 0, 0);
+SIMPLEBUS_PNP_INFO(compat_data);
diff --git a/sys/arm64/rockchip/rk_i2s.c b/sys/arm64/rockchip/rk_i2s.c
new file mode 100644
index 000000000000..8f53d8581d5c
--- /dev/null
+++ b/sys/arm64/rockchip/rk_i2s.c
@@ -0,0 +1,657 @@
+/*-
+ * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
+ *
+ * Copyright (c) 2019 Oleksandr Tymoshenko <gonzo@FreeBSD.org>
+ *
+ * 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 AUTHOR ``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 AUTHOR 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.
+ *
+ * $FreeBSD$
+ */
+
+#include <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/bus.h>
+#include <sys/kernel.h>
+#include <sys/lock.h>
+#include <sys/module.h>
+#include <sys/mutex.h>
+#include <sys/rman.h>
+#include <sys/resource.h>
+#include <machine/bus.h>
+
+#include <dev/ofw/ofw_bus.h>
+#include <dev/ofw/ofw_bus_subr.h>
+
+#include <dev/extres/clk/clk.h>
+#include <dev/extres/hwreset/hwreset.h>
+#include <dev/extres/syscon/syscon.h>
+
+#include "syscon_if.h"
+
+#include "opt_snd.h"
+#include <dev/sound/pcm/sound.h>
+#include <dev/sound/fdt/audio_dai.h>
+#include "audio_dai_if.h"
+
+#define	AUDIO_BUFFER_SIZE	48000 * 4
+
+#define	I2S_TXCR	0x0000
+#define		I2S_CSR_2		(0 << 15)
+#define		I2S_CSR_4		(1 << 15)
+#define		I2S_CSR_6		(2 << 15)
+#define		I2S_CSR_8		(3 << 15)
+#define		I2S_TXCR_IBM_NORMAL	(0 << 9)
+#define		I2S_TXCR_IBM_LJ		(1 << 9)
+#define		I2S_TXCR_IBM_RJ		(2 << 9)
+#define		I2S_TXCR_PBM_NODELAY	(0 << 7)
+#define		I2S_TXCR_PBM_1		(1 << 7)
+#define		I2S_TXCR_PBM_2		(2 << 7)
+#define		I2S_TXCR_PBM_3		(3 << 7)
+#define		I2S_TXCR_TFS_I2S	(0 << 5)
+#define		I2S_TXCR_TFS_PCM	(1 << 5)
+#define		I2S_TXCR_VDW_16		(0xf << 0)
+#define	I2S_RXCR	0x0004
+#define		I2S_RXCR_IBM_NORMAL	(0 << 9)
+#define		I2S_RXCR_IBM_LJ		(1 << 9)
+#define		I2S_RXCR_IBM_RJ		(2 << 9)
+#define		I2S_RXCR_PBM_NODELAY	(0 << 7)
+#define		I2S_RXCR_PBM_1		(1 << 7)
+#define		I2S_RXCR_PBM_2		(2 << 7)
+#define		I2S_RXCR_PBM_3		(3 << 7)
+#define		I2S_RXCR_TFS_I2S	(0 << 5)
+#define		I2S_RXCR_TFS_PCM	(1 << 5)
+#define		I2S_RXCR_VDW_16		(0xf << 0)
+#define	I2S_CKR		0x0008
+#define		I2S_CKR_MSS_MASK	(1 << 27)
+#define		I2S_CKR_MSS_MASTER	(0 << 27)
+#define		I2S_CKR_MSS_SLAVE	(1 << 27)
+#define		I2S_CKR_CKP		(1 << 26)
+#define		I2S_CKR_MDIV(n)		(((n) - 1) << 16)
+#define		I2S_CKR_MDIV_MASK	(0xff << 16)
+#define		I2S_CKR_RSD(n)		(((n) - 1) << 8)
+#define		I2S_CKR_RSD_MASK	(0xff << 8)
+#define		I2S_CKR_TSD(n)		(((n) - 1) << 0)
+#define		I2S_CKR_TSD_MASK	(0xff << 0)
+#define	I2S_TXFIFOLR	0x000c
+#define		TXFIFO0LR_MASK		0x3f
+#define	I2S_DMACR	0x0010
+#define		I2S_DMACR_RDE_ENABLE	(1 << 24)
+#define		I2S_DMACR_RDL(n)	((n) << 16)
+#define		I2S_DMACR_TDE_ENABLE	(1 << 8)
+#define		I2S_DMACR_TDL(n)	((n) << 0)
+#define	I2S_INTCR	0x0014
+#define		I2S_INTCR_RFT(n)	(((n) - 1) << 20)
+#define		I2S_INTCR_TFT(n)	(((n) - 1) << 4)
+#define		I2S_INTCR_RXFIE		(1 << 16)
+#define		I2S_INTCR_TXUIC		(1 << 2)
+#define		I2S_INTCR_TXEIE		(1 << 0)
+#define	I2S_INTSR	0x0018
+#define		I2S_INTSR_RXFI		(1 << 16)
+#define		I2S_INTSR_TXUI		(1 << 1)
+#define		I2S_INTSR_TXEI		(1 << 0)
+#define	I2S_XFER	0x001c
+#define		I2S_XFER_RXS_START	(1 << 1)
+#define		I2S_XFER_TXS_START	(1 << 0)
+#define	I2S_CLR		0x0020
+#define		I2S_CLR_RXC		(1 << 1)
+#define		I2S_CLR_TXC		(1 << 0)
+#define	I2S_TXDR	0x0024
+#define	I2S_RXDR	0x0028
+#define	I2S_RXFIFOLR	0x002c
+#define		RXFIFO0LR_MASK		0x3f
+
+/* syscon */
+#define	GRF_SOC_CON8			0xe220
+#define	I2S_IO_DIRECTION_MASK		7
+#define	I2S_IO_DIRECTION_SHIFT		11
+#define	I2S_IO_8CH_OUT_2CH_IN		0
+#define	I2S_IO_6CH_OUT_4CH_IN		4
+#define	I2S_IO_4CH_OUT_6CH_IN		6
+#define	I2S_IO_2CH_OUT_8CH_IN		7
+
+#define DIV_ROUND_CLOSEST(n,d)  (((n) + (d) / 2) / (d))
+
+#define	RK_I2S_SAMPLING_RATE	48000
+#define	FIFO_SIZE	32
+
+static struct ofw_compat_data compat_data[] = {
+	{ "rockchip,rk3066-i2s",		1 },
+	{ "rockchip,rk3399-i2s",		1 },
+	{ NULL,					0 }
+};
+
+static struct resource_spec rk_i2s_spec[] = {
+	{ SYS_RES_MEMORY,	0,	RF_ACTIVE },
+	{ SYS_RES_IRQ,		0,	RF_ACTIVE | RF_SHAREABLE },
+	{ -1, 0 }
+};
+
+struct rk_i2s_softc {
+	device_t	dev;
+	struct resource	*res[2];
+	struct mtx	mtx;
+	clk_t		clk;
+	clk_t		hclk;
+	void *		intrhand;
+	struct syscon	*grf;
+	/* pointers to playback/capture buffers */
+	uint32_t	play_ptr;
+	uint32_t	rec_ptr;
+};
+
+#define	RK_I2S_LOCK(sc)			mtx_lock(&(sc)->mtx)
+#define	RK_I2S_UNLOCK(sc)		mtx_unlock(&(sc)->mtx)
+#define	RK_I2S_READ_4(sc, reg)		bus_read_4((sc)->res[0], (reg))
+#define	RK_I2S_WRITE_4(sc, reg, val)	bus_write_4((sc)->res[0], (reg), (val))
+
+static int rk_i2s_probe(device_t dev);
+static int rk_i2s_attach(device_t dev);
+static int rk_i2s_detach(device_t dev);
+
+static uint32_t sc_fmt[] = {
+	SND_FORMAT(AFMT_S16_LE, 2, 0),
+	0
+};
+static struct pcmchan_caps rk_i2s_caps = {RK_I2S_SAMPLING_RATE, RK_I2S_SAMPLING_RATE, sc_fmt, 0};
+
+
+static int
+rk_i2s_init(struct rk_i2s_softc *sc)
+{
+	uint32_t val;
+	int error;
+
+	clk_set_freq(sc->clk, RK_I2S_SAMPLING_RATE * 256,
+	    CLK_SET_ROUND_DOWN);
+	error = clk_enable(sc->clk);
+	if (error != 0) {
+		device_printf(sc->dev, "cannot enable i2s_clk clock\n");
+		return (ENXIO);
+	}
+
+	val = I2S_INTCR_TFT(FIFO_SIZE/2);
+	val |= I2S_INTCR_RFT(FIFO_SIZE/2);
+	RK_I2S_WRITE_4(sc, I2S_INTCR, val);
+
+	if (sc->grf) {
+		val = (I2S_IO_2CH_OUT_8CH_IN << I2S_IO_DIRECTION_SHIFT);
+		val |= (I2S_IO_DIRECTION_MASK << I2S_IO_DIRECTION_SHIFT) << 16;
+		SYSCON_WRITE_4(sc->grf, GRF_SOC_CON8, val);
+
+		#if 0
+		// HACK: enable IO domain
+		val = (1 << 1);
+		val |= (1 << 1) << 16;
+		SYSCON_WRITE_4(sc->grf, 0xe640, val);
+		#endif
+	}
+
+	RK_I2S_WRITE_4(sc, I2S_XFER, 0);
+
+	return (0);
+}
+
+static int
+rk_i2s_probe(device_t dev)
+{
+	if (!ofw_bus_status_okay(dev))
+		return (ENXIO);
+
+	if (!ofw_bus_search_compatible(dev, compat_data)->ocd_data)
+		return (ENXIO);
+
+	device_set_desc(dev, "Rockchip I2S");
+	return (BUS_PROBE_DEFAULT);
+}
+
+static int
+rk_i2s_attach(device_t dev)
+{
+	struct rk_i2s_softc *sc;
+	int error;
+	phandle_t node;
+
+	sc = device_get_softc(dev);
+	sc->dev = dev;
+
+	mtx_init(&sc->mtx, device_get_nameunit(dev), NULL, MTX_DEF);
+
+	if (bus_alloc_resources(dev, rk_i2s_spec, sc->res) != 0) {
+		device_printf(dev, "cannot allocate resources for device\n");
+		error = ENXIO;
+		goto fail;
+	}
+
+	error = clk_get_by_ofw_name(dev, 0, "i2s_hclk", &sc->hclk);
+	if (error != 0) {
+		device_printf(dev, "cannot get i2s_hclk clock\n");
+		goto fail;
+	}
+
+	error = clk_get_by_ofw_name(dev, 0, "i2s_clk", &sc->clk);
+	if (error != 0) {
+		device_printf(dev, "cannot get i2s_clk clock\n");
+		goto fail;
+	}
+
+	/* Activate the module clock. */
+	error = clk_enable(sc->hclk);
+	if (error != 0) {
+		device_printf(dev, "cannot enable i2s_hclk clock\n");
+		goto fail;
+	}
+
+	node = ofw_bus_get_node(dev);
+	if (OF_hasprop(node, "rockchip,grf") &&
+	    syscon_get_by_ofw_property(dev, node,
+	    "rockchip,grf", &sc->grf) != 0) {
+		device_printf(dev, "cannot get grf driver handle\n");
+		return (ENXIO);
+	}
+
+	rk_i2s_init(sc);
+
+	OF_device_register_xref(OF_xref_from_node(node), dev);
+
+	return (0);
+
+fail:
+	rk_i2s_detach(dev);
+	return (error);
+}
+
+static int
+rk_i2s_detach(device_t dev)
+{
+	struct rk_i2s_softc *i2s;
+
+	i2s = device_get_softc(dev);
+
+	if (i2s->hclk != NULL)
+		clk_release(i2s->hclk);
+	if (i2s->clk)
+		clk_release(i2s->clk);
+
+	if (i2s->intrhand != NULL)
+		bus_teardown_intr(i2s->dev, i2s->res[1], i2s->intrhand);
+
+	bus_release_resources(dev, rk_i2s_spec, i2s->res);
+	mtx_destroy(&i2s->mtx);
+
+	return (0);
+}
+
+static int
+rk_i2s_dai_init(device_t dev, uint32_t format)
+{
+	uint32_t val, txcr, rxcr;
+	struct rk_i2s_softc *sc;
+	int fmt, pol, clk;
+
+	sc = device_get_softc(dev);
+
+	fmt = AUDIO_DAI_FORMAT_FORMAT(format);
+	pol = AUDIO_DAI_FORMAT_POLARITY(format);
+	clk = AUDIO_DAI_FORMAT_CLOCK(format);
+
+	/* Set format */
+	val = RK_I2S_READ_4(sc, I2S_CKR);
+
+	val &= ~(I2S_CKR_MSS_MASK);
+	switch (clk) {
+	case AUDIO_DAI_CLOCK_CBM_CFM:
+		val |= I2S_CKR_MSS_MASTER;
+		break;
+	case AUDIO_DAI_CLOCK_CBS_CFS:
+		val |= I2S_CKR_MSS_SLAVE;
+		break;
+	default:
+		return (EINVAL);
+	}
+
+	switch (pol) {
+	case AUDIO_DAI_POLARITY_IB_NF:
+		val |= I2S_CKR_CKP;
+		break;
+	case AUDIO_DAI_POLARITY_NB_NF:
+		val &= ~I2S_CKR_CKP;
+		break;
+	default:
+		return (EINVAL);
+	}
+
+	RK_I2S_WRITE_4(sc, I2S_CKR, val);
+
+	txcr = I2S_TXCR_VDW_16 | I2S_CSR_2;
+	rxcr = I2S_RXCR_VDW_16 | I2S_CSR_2;
+
+	switch (fmt) {
+	case AUDIO_DAI_FORMAT_I2S:
+		txcr |= I2S_TXCR_IBM_NORMAL;
+		rxcr |= I2S_RXCR_IBM_NORMAL;
+		break;
+	case AUDIO_DAI_FORMAT_LJ:
+		txcr |= I2S_TXCR_IBM_LJ;
+		rxcr |= I2S_RXCR_IBM_LJ;
+		break;
+	case AUDIO_DAI_FORMAT_RJ:
*** 314 LINES SKIPPED ***



Want to link to this message? Use this URL: <https://mail-archive.FreeBSD.org/cgi/mid.cgi?202111061749.1A6HnqCP018142>