xref: /freebsd-src/sys/arm64/rockchip/rk_i2s.c (revision 89cb925fddac372f74068b9e57528090299032a2)
1aa917184SOleksandr Tymoshenko /*-
24d846d26SWarner Losh  * SPDX-License-Identifier: BSD-2-Clause
3aa917184SOleksandr Tymoshenko  *
4aa917184SOleksandr Tymoshenko  * Copyright (c) 2019 Oleksandr Tymoshenko <gonzo@FreeBSD.org>
5aa917184SOleksandr Tymoshenko  *
6aa917184SOleksandr Tymoshenko  * Redistribution and use in source and binary forms, with or without
7aa917184SOleksandr Tymoshenko  * modification, are permitted provided that the following conditions
8aa917184SOleksandr Tymoshenko  * are met:
9aa917184SOleksandr Tymoshenko  * 1. Redistributions of source code must retain the above copyright
10aa917184SOleksandr Tymoshenko  *    notice, this list of conditions and the following disclaimer.
11aa917184SOleksandr Tymoshenko  * 2. Redistributions in binary form must reproduce the above copyright
12aa917184SOleksandr Tymoshenko  *    notice, this list of conditions and the following disclaimer in the
13aa917184SOleksandr Tymoshenko  *    documentation and/or other materials provided with the distribution.
14aa917184SOleksandr Tymoshenko  *
15aa917184SOleksandr Tymoshenko  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16aa917184SOleksandr Tymoshenko  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17aa917184SOleksandr Tymoshenko  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18aa917184SOleksandr Tymoshenko  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19aa917184SOleksandr Tymoshenko  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
20aa917184SOleksandr Tymoshenko  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
21aa917184SOleksandr Tymoshenko  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
22aa917184SOleksandr Tymoshenko  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
23aa917184SOleksandr Tymoshenko  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24aa917184SOleksandr Tymoshenko  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25aa917184SOleksandr Tymoshenko  * SUCH DAMAGE.
26aa917184SOleksandr Tymoshenko  */
27aa917184SOleksandr Tymoshenko 
28aa917184SOleksandr Tymoshenko #include <sys/param.h>
29aa917184SOleksandr Tymoshenko #include <sys/systm.h>
30aa917184SOleksandr Tymoshenko #include <sys/bus.h>
31aa917184SOleksandr Tymoshenko #include <sys/kernel.h>
32aa917184SOleksandr Tymoshenko #include <sys/lock.h>
33aa917184SOleksandr Tymoshenko #include <sys/module.h>
34aa917184SOleksandr Tymoshenko #include <sys/mutex.h>
35aa917184SOleksandr Tymoshenko #include <sys/rman.h>
36aa917184SOleksandr Tymoshenko #include <sys/resource.h>
37aa917184SOleksandr Tymoshenko #include <machine/bus.h>
38aa917184SOleksandr Tymoshenko 
39aa917184SOleksandr Tymoshenko #include <dev/ofw/ofw_bus.h>
40aa917184SOleksandr Tymoshenko #include <dev/ofw/ofw_bus_subr.h>
41aa917184SOleksandr Tymoshenko 
42be82b3a0SEmmanuel Vadot #include <dev/clk/clk.h>
431f469a9fSEmmanuel Vadot #include <dev/hwreset/hwreset.h>
4462e8ccc3SEmmanuel Vadot #include <dev/syscon/syscon.h>
45aa917184SOleksandr Tymoshenko 
46aa917184SOleksandr Tymoshenko #include "syscon_if.h"
47aa917184SOleksandr Tymoshenko 
48aa917184SOleksandr Tymoshenko #include "opt_snd.h"
49aa917184SOleksandr Tymoshenko #include <dev/sound/pcm/sound.h>
50aa917184SOleksandr Tymoshenko #include <dev/sound/fdt/audio_dai.h>
51aa917184SOleksandr Tymoshenko #include "audio_dai_if.h"
52aa917184SOleksandr Tymoshenko 
53aa917184SOleksandr Tymoshenko #define	I2S_TXCR	0x0000
54aa917184SOleksandr Tymoshenko #define		I2S_CSR_2		(0 << 15)
55aa917184SOleksandr Tymoshenko #define		I2S_CSR_4		(1 << 15)
56aa917184SOleksandr Tymoshenko #define		I2S_CSR_6		(2 << 15)
57aa917184SOleksandr Tymoshenko #define		I2S_CSR_8		(3 << 15)
58aa917184SOleksandr Tymoshenko #define		I2S_TXCR_IBM_NORMAL	(0 << 9)
59aa917184SOleksandr Tymoshenko #define		I2S_TXCR_IBM_LJ		(1 << 9)
60aa917184SOleksandr Tymoshenko #define		I2S_TXCR_IBM_RJ		(2 << 9)
61aa917184SOleksandr Tymoshenko #define		I2S_TXCR_PBM_NODELAY	(0 << 7)
62aa917184SOleksandr Tymoshenko #define		I2S_TXCR_PBM_1		(1 << 7)
63aa917184SOleksandr Tymoshenko #define		I2S_TXCR_PBM_2		(2 << 7)
64aa917184SOleksandr Tymoshenko #define		I2S_TXCR_PBM_3		(3 << 7)
65aa917184SOleksandr Tymoshenko #define		I2S_TXCR_TFS_I2S	(0 << 5)
66aa917184SOleksandr Tymoshenko #define		I2S_TXCR_TFS_PCM	(1 << 5)
67aa917184SOleksandr Tymoshenko #define		I2S_TXCR_VDW_16		(0xf << 0)
68aa917184SOleksandr Tymoshenko #define	I2S_RXCR	0x0004
69aa917184SOleksandr Tymoshenko #define		I2S_RXCR_IBM_NORMAL	(0 << 9)
70aa917184SOleksandr Tymoshenko #define		I2S_RXCR_IBM_LJ		(1 << 9)
71aa917184SOleksandr Tymoshenko #define		I2S_RXCR_IBM_RJ		(2 << 9)
72aa917184SOleksandr Tymoshenko #define		I2S_RXCR_PBM_NODELAY	(0 << 7)
73aa917184SOleksandr Tymoshenko #define		I2S_RXCR_PBM_1		(1 << 7)
74aa917184SOleksandr Tymoshenko #define		I2S_RXCR_PBM_2		(2 << 7)
75aa917184SOleksandr Tymoshenko #define		I2S_RXCR_PBM_3		(3 << 7)
76aa917184SOleksandr Tymoshenko #define		I2S_RXCR_TFS_I2S	(0 << 5)
77aa917184SOleksandr Tymoshenko #define		I2S_RXCR_TFS_PCM	(1 << 5)
78aa917184SOleksandr Tymoshenko #define		I2S_RXCR_VDW_16		(0xf << 0)
79aa917184SOleksandr Tymoshenko #define	I2S_CKR		0x0008
80aa917184SOleksandr Tymoshenko #define		I2S_CKR_MSS_MASK	(1 << 27)
81aa917184SOleksandr Tymoshenko #define		I2S_CKR_MSS_MASTER	(0 << 27)
82aa917184SOleksandr Tymoshenko #define		I2S_CKR_MSS_SLAVE	(1 << 27)
83aa917184SOleksandr Tymoshenko #define		I2S_CKR_CKP		(1 << 26)
84aa917184SOleksandr Tymoshenko #define		I2S_CKR_MDIV(n)		(((n) - 1) << 16)
85aa917184SOleksandr Tymoshenko #define		I2S_CKR_MDIV_MASK	(0xff << 16)
86aa917184SOleksandr Tymoshenko #define		I2S_CKR_RSD(n)		(((n) - 1) << 8)
87aa917184SOleksandr Tymoshenko #define		I2S_CKR_RSD_MASK	(0xff << 8)
88aa917184SOleksandr Tymoshenko #define		I2S_CKR_TSD(n)		(((n) - 1) << 0)
89aa917184SOleksandr Tymoshenko #define		I2S_CKR_TSD_MASK	(0xff << 0)
90aa917184SOleksandr Tymoshenko #define	I2S_TXFIFOLR	0x000c
91aa917184SOleksandr Tymoshenko #define		TXFIFO0LR_MASK		0x3f
92aa917184SOleksandr Tymoshenko #define	I2S_DMACR	0x0010
93aa917184SOleksandr Tymoshenko #define		I2S_DMACR_RDE_ENABLE	(1 << 24)
94aa917184SOleksandr Tymoshenko #define		I2S_DMACR_RDL(n)	((n) << 16)
95aa917184SOleksandr Tymoshenko #define		I2S_DMACR_TDE_ENABLE	(1 << 8)
96aa917184SOleksandr Tymoshenko #define		I2S_DMACR_TDL(n)	((n) << 0)
97aa917184SOleksandr Tymoshenko #define	I2S_INTCR	0x0014
98aa917184SOleksandr Tymoshenko #define		I2S_INTCR_RFT(n)	(((n) - 1) << 20)
99aa917184SOleksandr Tymoshenko #define		I2S_INTCR_TFT(n)	(((n) - 1) << 4)
100aa917184SOleksandr Tymoshenko #define		I2S_INTCR_RXFIE		(1 << 16)
101aa917184SOleksandr Tymoshenko #define		I2S_INTCR_TXUIC		(1 << 2)
102aa917184SOleksandr Tymoshenko #define		I2S_INTCR_TXEIE		(1 << 0)
103aa917184SOleksandr Tymoshenko #define	I2S_INTSR	0x0018
104aa917184SOleksandr Tymoshenko #define		I2S_INTSR_RXFI		(1 << 16)
105aa917184SOleksandr Tymoshenko #define		I2S_INTSR_TXUI		(1 << 1)
106aa917184SOleksandr Tymoshenko #define		I2S_INTSR_TXEI		(1 << 0)
107aa917184SOleksandr Tymoshenko #define	I2S_XFER	0x001c
108aa917184SOleksandr Tymoshenko #define		I2S_XFER_RXS_START	(1 << 1)
109aa917184SOleksandr Tymoshenko #define		I2S_XFER_TXS_START	(1 << 0)
110aa917184SOleksandr Tymoshenko #define	I2S_CLR		0x0020
111aa917184SOleksandr Tymoshenko #define		I2S_CLR_RXC		(1 << 1)
112aa917184SOleksandr Tymoshenko #define		I2S_CLR_TXC		(1 << 0)
113aa917184SOleksandr Tymoshenko #define	I2S_TXDR	0x0024
114aa917184SOleksandr Tymoshenko #define	I2S_RXDR	0x0028
115aa917184SOleksandr Tymoshenko #define	I2S_RXFIFOLR	0x002c
116aa917184SOleksandr Tymoshenko #define		RXFIFO0LR_MASK		0x3f
117aa917184SOleksandr Tymoshenko 
118aa917184SOleksandr Tymoshenko /* syscon */
119aa917184SOleksandr Tymoshenko #define	GRF_SOC_CON8			0xe220
120aa917184SOleksandr Tymoshenko #define	I2S_IO_DIRECTION_MASK		7
121aa917184SOleksandr Tymoshenko #define	I2S_IO_DIRECTION_SHIFT		11
122aa917184SOleksandr Tymoshenko #define	I2S_IO_8CH_OUT_2CH_IN		0
123aa917184SOleksandr Tymoshenko #define	I2S_IO_6CH_OUT_4CH_IN		4
124aa917184SOleksandr Tymoshenko #define	I2S_IO_4CH_OUT_6CH_IN		6
125aa917184SOleksandr Tymoshenko #define	I2S_IO_2CH_OUT_8CH_IN		7
126aa917184SOleksandr Tymoshenko 
127aa917184SOleksandr Tymoshenko #define DIV_ROUND_CLOSEST(n,d)  (((n) + (d) / 2) / (d))
128aa917184SOleksandr Tymoshenko 
129aa917184SOleksandr Tymoshenko #define	RK_I2S_SAMPLING_RATE	48000
130aa917184SOleksandr Tymoshenko #define	FIFO_SIZE	32
131aa917184SOleksandr Tymoshenko 
132aa917184SOleksandr Tymoshenko static struct ofw_compat_data compat_data[] = {
133aa917184SOleksandr Tymoshenko 	{ "rockchip,rk3066-i2s",		1 },
134aa917184SOleksandr Tymoshenko 	{ "rockchip,rk3399-i2s",		1 },
135aa917184SOleksandr Tymoshenko 	{ NULL,					0 }
136aa917184SOleksandr Tymoshenko };
137aa917184SOleksandr Tymoshenko 
138aa917184SOleksandr Tymoshenko static struct resource_spec rk_i2s_spec[] = {
139aa917184SOleksandr Tymoshenko 	{ SYS_RES_MEMORY,	0,	RF_ACTIVE },
140aa917184SOleksandr Tymoshenko 	{ SYS_RES_IRQ,		0,	RF_ACTIVE | RF_SHAREABLE },
141aa917184SOleksandr Tymoshenko 	{ -1, 0 }
142aa917184SOleksandr Tymoshenko };
143aa917184SOleksandr Tymoshenko 
144aa917184SOleksandr Tymoshenko struct rk_i2s_softc {
145aa917184SOleksandr Tymoshenko 	device_t	dev;
146aa917184SOleksandr Tymoshenko 	struct resource	*res[2];
147aa917184SOleksandr Tymoshenko 	struct mtx	mtx;
148aa917184SOleksandr Tymoshenko 	clk_t		clk;
149aa917184SOleksandr Tymoshenko 	clk_t		hclk;
150aa917184SOleksandr Tymoshenko 	void *		intrhand;
151aa917184SOleksandr Tymoshenko 	struct syscon	*grf;
152aa917184SOleksandr Tymoshenko 	/* pointers to playback/capture buffers */
153aa917184SOleksandr Tymoshenko 	uint32_t	play_ptr;
154aa917184SOleksandr Tymoshenko 	uint32_t	rec_ptr;
155aa917184SOleksandr Tymoshenko };
156aa917184SOleksandr Tymoshenko 
157aa917184SOleksandr Tymoshenko #define	RK_I2S_LOCK(sc)			mtx_lock(&(sc)->mtx)
158aa917184SOleksandr Tymoshenko #define	RK_I2S_UNLOCK(sc)		mtx_unlock(&(sc)->mtx)
159aa917184SOleksandr Tymoshenko #define	RK_I2S_READ_4(sc, reg)		bus_read_4((sc)->res[0], (reg))
160aa917184SOleksandr Tymoshenko #define	RK_I2S_WRITE_4(sc, reg, val)	bus_write_4((sc)->res[0], (reg), (val))
161aa917184SOleksandr Tymoshenko 
162aa917184SOleksandr Tymoshenko static int rk_i2s_probe(device_t dev);
163aa917184SOleksandr Tymoshenko static int rk_i2s_attach(device_t dev);
164aa917184SOleksandr Tymoshenko static int rk_i2s_detach(device_t dev);
165aa917184SOleksandr Tymoshenko 
166aa917184SOleksandr Tymoshenko static uint32_t sc_fmt[] = {
167aa917184SOleksandr Tymoshenko 	SND_FORMAT(AFMT_S16_LE, 2, 0),
168aa917184SOleksandr Tymoshenko 	0
169aa917184SOleksandr Tymoshenko };
170aa917184SOleksandr Tymoshenko static struct pcmchan_caps rk_i2s_caps = {RK_I2S_SAMPLING_RATE, RK_I2S_SAMPLING_RATE, sc_fmt, 0};
171aa917184SOleksandr Tymoshenko 
172aa917184SOleksandr Tymoshenko 
173aa917184SOleksandr Tymoshenko static int
rk_i2s_init(struct rk_i2s_softc * sc)174aa917184SOleksandr Tymoshenko rk_i2s_init(struct rk_i2s_softc *sc)
175aa917184SOleksandr Tymoshenko {
176aa917184SOleksandr Tymoshenko 	uint32_t val;
177aa917184SOleksandr Tymoshenko 	int error;
178aa917184SOleksandr Tymoshenko 
179aa917184SOleksandr Tymoshenko 	clk_set_freq(sc->clk, RK_I2S_SAMPLING_RATE * 256,
180aa917184SOleksandr Tymoshenko 	    CLK_SET_ROUND_DOWN);
181aa917184SOleksandr Tymoshenko 	error = clk_enable(sc->clk);
182aa917184SOleksandr Tymoshenko 	if (error != 0) {
183aa917184SOleksandr Tymoshenko 		device_printf(sc->dev, "cannot enable i2s_clk clock\n");
184aa917184SOleksandr Tymoshenko 		return (ENXIO);
185aa917184SOleksandr Tymoshenko 	}
186aa917184SOleksandr Tymoshenko 
187aa917184SOleksandr Tymoshenko 	val = I2S_INTCR_TFT(FIFO_SIZE/2);
188aa917184SOleksandr Tymoshenko 	val |= I2S_INTCR_RFT(FIFO_SIZE/2);
189aa917184SOleksandr Tymoshenko 	RK_I2S_WRITE_4(sc, I2S_INTCR, val);
190aa917184SOleksandr Tymoshenko 
1915d1a2edeSAndriy Gapon 	if (sc->grf && ofw_bus_is_compatible(sc->dev, "rockchip,rk3399-i2s")) {
192aa917184SOleksandr Tymoshenko 		val = (I2S_IO_2CH_OUT_8CH_IN << I2S_IO_DIRECTION_SHIFT);
193aa917184SOleksandr Tymoshenko 		val |= (I2S_IO_DIRECTION_MASK << I2S_IO_DIRECTION_SHIFT) << 16;
194aa917184SOleksandr Tymoshenko 		SYSCON_WRITE_4(sc->grf, GRF_SOC_CON8, val);
195aa917184SOleksandr Tymoshenko 
196aa917184SOleksandr Tymoshenko 		#if 0
197aa917184SOleksandr Tymoshenko 		// HACK: enable IO domain
198aa917184SOleksandr Tymoshenko 		val = (1 << 1);
199aa917184SOleksandr Tymoshenko 		val |= (1 << 1) << 16;
200aa917184SOleksandr Tymoshenko 		SYSCON_WRITE_4(sc->grf, 0xe640, val);
201aa917184SOleksandr Tymoshenko 		#endif
202aa917184SOleksandr Tymoshenko 	}
203aa917184SOleksandr Tymoshenko 
204aa917184SOleksandr Tymoshenko 	RK_I2S_WRITE_4(sc, I2S_XFER, 0);
205aa917184SOleksandr Tymoshenko 
206aa917184SOleksandr Tymoshenko 	return (0);
207aa917184SOleksandr Tymoshenko }
208aa917184SOleksandr Tymoshenko 
209aa917184SOleksandr Tymoshenko static int
rk_i2s_probe(device_t dev)210aa917184SOleksandr Tymoshenko rk_i2s_probe(device_t dev)
211aa917184SOleksandr Tymoshenko {
212aa917184SOleksandr Tymoshenko 	if (!ofw_bus_status_okay(dev))
213aa917184SOleksandr Tymoshenko 		return (ENXIO);
214aa917184SOleksandr Tymoshenko 
215aa917184SOleksandr Tymoshenko 	if (!ofw_bus_search_compatible(dev, compat_data)->ocd_data)
216aa917184SOleksandr Tymoshenko 		return (ENXIO);
217aa917184SOleksandr Tymoshenko 
218aa917184SOleksandr Tymoshenko 	device_set_desc(dev, "Rockchip I2S");
219aa917184SOleksandr Tymoshenko 	return (BUS_PROBE_DEFAULT);
220aa917184SOleksandr Tymoshenko }
221aa917184SOleksandr Tymoshenko 
222aa917184SOleksandr Tymoshenko static int
rk_i2s_attach(device_t dev)223aa917184SOleksandr Tymoshenko rk_i2s_attach(device_t dev)
224aa917184SOleksandr Tymoshenko {
225aa917184SOleksandr Tymoshenko 	struct rk_i2s_softc *sc;
226aa917184SOleksandr Tymoshenko 	int error;
227aa917184SOleksandr Tymoshenko 	phandle_t node;
228aa917184SOleksandr Tymoshenko 
229aa917184SOleksandr Tymoshenko 	sc = device_get_softc(dev);
230aa917184SOleksandr Tymoshenko 	sc->dev = dev;
231aa917184SOleksandr Tymoshenko 
232aa917184SOleksandr Tymoshenko 	mtx_init(&sc->mtx, device_get_nameunit(dev), NULL, MTX_DEF);
233aa917184SOleksandr Tymoshenko 
234aa917184SOleksandr Tymoshenko 	if (bus_alloc_resources(dev, rk_i2s_spec, sc->res) != 0) {
235aa917184SOleksandr Tymoshenko 		device_printf(dev, "cannot allocate resources for device\n");
236aa917184SOleksandr Tymoshenko 		error = ENXIO;
237aa917184SOleksandr Tymoshenko 		goto fail;
238aa917184SOleksandr Tymoshenko 	}
239aa917184SOleksandr Tymoshenko 
240aa917184SOleksandr Tymoshenko 	error = clk_get_by_ofw_name(dev, 0, "i2s_hclk", &sc->hclk);
241aa917184SOleksandr Tymoshenko 	if (error != 0) {
242aa917184SOleksandr Tymoshenko 		device_printf(dev, "cannot get i2s_hclk clock\n");
243aa917184SOleksandr Tymoshenko 		goto fail;
244aa917184SOleksandr Tymoshenko 	}
245aa917184SOleksandr Tymoshenko 
246aa917184SOleksandr Tymoshenko 	error = clk_get_by_ofw_name(dev, 0, "i2s_clk", &sc->clk);
247aa917184SOleksandr Tymoshenko 	if (error != 0) {
248aa917184SOleksandr Tymoshenko 		device_printf(dev, "cannot get i2s_clk clock\n");
249aa917184SOleksandr Tymoshenko 		goto fail;
250aa917184SOleksandr Tymoshenko 	}
251aa917184SOleksandr Tymoshenko 
252aa917184SOleksandr Tymoshenko 	/* Activate the module clock. */
253aa917184SOleksandr Tymoshenko 	error = clk_enable(sc->hclk);
254aa917184SOleksandr Tymoshenko 	if (error != 0) {
255aa917184SOleksandr Tymoshenko 		device_printf(dev, "cannot enable i2s_hclk clock\n");
256aa917184SOleksandr Tymoshenko 		goto fail;
257aa917184SOleksandr Tymoshenko 	}
258aa917184SOleksandr Tymoshenko 
259aa917184SOleksandr Tymoshenko 	node = ofw_bus_get_node(dev);
260aa917184SOleksandr Tymoshenko 	if (OF_hasprop(node, "rockchip,grf") &&
261aa917184SOleksandr Tymoshenko 	    syscon_get_by_ofw_property(dev, node,
262aa917184SOleksandr Tymoshenko 	    "rockchip,grf", &sc->grf) != 0) {
263aa917184SOleksandr Tymoshenko 		device_printf(dev, "cannot get grf driver handle\n");
264aa917184SOleksandr Tymoshenko 		return (ENXIO);
265aa917184SOleksandr Tymoshenko 	}
266aa917184SOleksandr Tymoshenko 
267aa917184SOleksandr Tymoshenko 	rk_i2s_init(sc);
268aa917184SOleksandr Tymoshenko 
269aa917184SOleksandr Tymoshenko 	OF_device_register_xref(OF_xref_from_node(node), dev);
270aa917184SOleksandr Tymoshenko 
271aa917184SOleksandr Tymoshenko 	return (0);
272aa917184SOleksandr Tymoshenko 
273aa917184SOleksandr Tymoshenko fail:
274aa917184SOleksandr Tymoshenko 	rk_i2s_detach(dev);
275aa917184SOleksandr Tymoshenko 	return (error);
276aa917184SOleksandr Tymoshenko }
277aa917184SOleksandr Tymoshenko 
278aa917184SOleksandr Tymoshenko static int
rk_i2s_detach(device_t dev)279aa917184SOleksandr Tymoshenko rk_i2s_detach(device_t dev)
280aa917184SOleksandr Tymoshenko {
281aa917184SOleksandr Tymoshenko 	struct rk_i2s_softc *i2s;
282aa917184SOleksandr Tymoshenko 
283aa917184SOleksandr Tymoshenko 	i2s = device_get_softc(dev);
284aa917184SOleksandr Tymoshenko 
285aa917184SOleksandr Tymoshenko 	if (i2s->hclk != NULL)
286aa917184SOleksandr Tymoshenko 		clk_release(i2s->hclk);
287aa917184SOleksandr Tymoshenko 	if (i2s->clk)
288aa917184SOleksandr Tymoshenko 		clk_release(i2s->clk);
289aa917184SOleksandr Tymoshenko 
290aa917184SOleksandr Tymoshenko 	if (i2s->intrhand != NULL)
291aa917184SOleksandr Tymoshenko 		bus_teardown_intr(i2s->dev, i2s->res[1], i2s->intrhand);
292aa917184SOleksandr Tymoshenko 
293aa917184SOleksandr Tymoshenko 	bus_release_resources(dev, rk_i2s_spec, i2s->res);
294aa917184SOleksandr Tymoshenko 	mtx_destroy(&i2s->mtx);
295aa917184SOleksandr Tymoshenko 
296aa917184SOleksandr Tymoshenko 	return (0);
297aa917184SOleksandr Tymoshenko }
298aa917184SOleksandr Tymoshenko 
299aa917184SOleksandr Tymoshenko static int
rk_i2s_dai_init(device_t dev,uint32_t format)300aa917184SOleksandr Tymoshenko rk_i2s_dai_init(device_t dev, uint32_t format)
301aa917184SOleksandr Tymoshenko {
302aa917184SOleksandr Tymoshenko 	uint32_t val, txcr, rxcr;
303aa917184SOleksandr Tymoshenko 	struct rk_i2s_softc *sc;
304aa917184SOleksandr Tymoshenko 	int fmt, pol, clk;
305aa917184SOleksandr Tymoshenko 
306aa917184SOleksandr Tymoshenko 	sc = device_get_softc(dev);
307aa917184SOleksandr Tymoshenko 
308aa917184SOleksandr Tymoshenko 	fmt = AUDIO_DAI_FORMAT_FORMAT(format);
309aa917184SOleksandr Tymoshenko 	pol = AUDIO_DAI_FORMAT_POLARITY(format);
310aa917184SOleksandr Tymoshenko 	clk = AUDIO_DAI_FORMAT_CLOCK(format);
311aa917184SOleksandr Tymoshenko 
312aa917184SOleksandr Tymoshenko 	/* Set format */
313aa917184SOleksandr Tymoshenko 	val = RK_I2S_READ_4(sc, I2S_CKR);
314aa917184SOleksandr Tymoshenko 
315aa917184SOleksandr Tymoshenko 	val &= ~(I2S_CKR_MSS_MASK);
316aa917184SOleksandr Tymoshenko 	switch (clk) {
317aa917184SOleksandr Tymoshenko 	case AUDIO_DAI_CLOCK_CBM_CFM:
318aa917184SOleksandr Tymoshenko 		val |= I2S_CKR_MSS_MASTER;
319aa917184SOleksandr Tymoshenko 		break;
320aa917184SOleksandr Tymoshenko 	case AUDIO_DAI_CLOCK_CBS_CFS:
321aa917184SOleksandr Tymoshenko 		val |= I2S_CKR_MSS_SLAVE;
322aa917184SOleksandr Tymoshenko 		break;
323aa917184SOleksandr Tymoshenko 	default:
324aa917184SOleksandr Tymoshenko 		return (EINVAL);
325aa917184SOleksandr Tymoshenko 	}
326aa917184SOleksandr Tymoshenko 
327aa917184SOleksandr Tymoshenko 	switch (pol) {
328aa917184SOleksandr Tymoshenko 	case AUDIO_DAI_POLARITY_IB_NF:
329aa917184SOleksandr Tymoshenko 		val |= I2S_CKR_CKP;
330aa917184SOleksandr Tymoshenko 		break;
331aa917184SOleksandr Tymoshenko 	case AUDIO_DAI_POLARITY_NB_NF:
332aa917184SOleksandr Tymoshenko 		val &= ~I2S_CKR_CKP;
333aa917184SOleksandr Tymoshenko 		break;
334aa917184SOleksandr Tymoshenko 	default:
335aa917184SOleksandr Tymoshenko 		return (EINVAL);
336aa917184SOleksandr Tymoshenko 	}
337aa917184SOleksandr Tymoshenko 
338aa917184SOleksandr Tymoshenko 	RK_I2S_WRITE_4(sc, I2S_CKR, val);
339aa917184SOleksandr Tymoshenko 
340aa917184SOleksandr Tymoshenko 	txcr = I2S_TXCR_VDW_16 | I2S_CSR_2;
341aa917184SOleksandr Tymoshenko 	rxcr = I2S_RXCR_VDW_16 | I2S_CSR_2;
342aa917184SOleksandr Tymoshenko 
343aa917184SOleksandr Tymoshenko 	switch (fmt) {
344aa917184SOleksandr Tymoshenko 	case AUDIO_DAI_FORMAT_I2S:
345aa917184SOleksandr Tymoshenko 		txcr |= I2S_TXCR_IBM_NORMAL;
346aa917184SOleksandr Tymoshenko 		rxcr |= I2S_RXCR_IBM_NORMAL;
347aa917184SOleksandr Tymoshenko 		break;
348aa917184SOleksandr Tymoshenko 	case AUDIO_DAI_FORMAT_LJ:
349aa917184SOleksandr Tymoshenko 		txcr |= I2S_TXCR_IBM_LJ;
350aa917184SOleksandr Tymoshenko 		rxcr |= I2S_RXCR_IBM_LJ;
351aa917184SOleksandr Tymoshenko 		break;
352aa917184SOleksandr Tymoshenko 	case AUDIO_DAI_FORMAT_RJ:
353aa917184SOleksandr Tymoshenko 		txcr |= I2S_TXCR_IBM_RJ;
354aa917184SOleksandr Tymoshenko 		rxcr |= I2S_RXCR_IBM_RJ;
355aa917184SOleksandr Tymoshenko 		break;
356aa917184SOleksandr Tymoshenko 	case AUDIO_DAI_FORMAT_DSPA:
357aa917184SOleksandr Tymoshenko 		txcr |= I2S_TXCR_TFS_PCM;
358aa917184SOleksandr Tymoshenko 		rxcr |= I2S_RXCR_TFS_PCM;
359aa917184SOleksandr Tymoshenko 		txcr |= I2S_TXCR_PBM_1;
360aa917184SOleksandr Tymoshenko 		rxcr |= I2S_RXCR_PBM_1;
361aa917184SOleksandr Tymoshenko 		break;
362aa917184SOleksandr Tymoshenko 	case AUDIO_DAI_FORMAT_DSPB:
363aa917184SOleksandr Tymoshenko 		txcr |= I2S_TXCR_TFS_PCM;
364aa917184SOleksandr Tymoshenko 		rxcr |= I2S_RXCR_TFS_PCM;
365aa917184SOleksandr Tymoshenko 		txcr |= I2S_TXCR_PBM_2;
366aa917184SOleksandr Tymoshenko 		rxcr |= I2S_RXCR_PBM_2;
367aa917184SOleksandr Tymoshenko 		break;
368aa917184SOleksandr Tymoshenko 	default:
369aa917184SOleksandr Tymoshenko 		return EINVAL;
370aa917184SOleksandr Tymoshenko 	}
371aa917184SOleksandr Tymoshenko 
372aa917184SOleksandr Tymoshenko 	RK_I2S_WRITE_4(sc, I2S_TXCR, txcr);
373aa917184SOleksandr Tymoshenko 	RK_I2S_WRITE_4(sc, I2S_RXCR, rxcr);
374aa917184SOleksandr Tymoshenko 
375aa917184SOleksandr Tymoshenko 	RK_I2S_WRITE_4(sc, I2S_XFER, 0);
376aa917184SOleksandr Tymoshenko 
377aa917184SOleksandr Tymoshenko 	return (0);
378aa917184SOleksandr Tymoshenko }
379aa917184SOleksandr Tymoshenko 
380aa917184SOleksandr Tymoshenko 
381aa917184SOleksandr Tymoshenko static int
rk_i2s_dai_intr(device_t dev,struct snd_dbuf * play_buf,struct snd_dbuf * rec_buf)382aa917184SOleksandr Tymoshenko rk_i2s_dai_intr(device_t dev, struct snd_dbuf *play_buf, struct snd_dbuf *rec_buf)
383aa917184SOleksandr Tymoshenko {
384aa917184SOleksandr Tymoshenko 	struct rk_i2s_softc *sc;
385aa917184SOleksandr Tymoshenko 	uint32_t status;
386aa917184SOleksandr Tymoshenko 	uint32_t level;
387aa917184SOleksandr Tymoshenko 	uint32_t val = 0x00;
388aa917184SOleksandr Tymoshenko 	int ret = 0;
389aa917184SOleksandr Tymoshenko 
390aa917184SOleksandr Tymoshenko 	sc = device_get_softc(dev);
391aa917184SOleksandr Tymoshenko 
392aa917184SOleksandr Tymoshenko 	RK_I2S_LOCK(sc);
393aa917184SOleksandr Tymoshenko 	status = RK_I2S_READ_4(sc, I2S_INTSR);
394aa917184SOleksandr Tymoshenko 
395aa917184SOleksandr Tymoshenko 	if (status & I2S_INTSR_TXEI) {
396aa917184SOleksandr Tymoshenko 		level = RK_I2S_READ_4(sc, I2S_TXFIFOLR) & TXFIFO0LR_MASK;
397aa917184SOleksandr Tymoshenko 		uint8_t *samples;
398aa917184SOleksandr Tymoshenko 		uint32_t count, size, readyptr, written;
399aa917184SOleksandr Tymoshenko 		count = sndbuf_getready(play_buf);
4002b556942SAndrew Turner 		if (count > FIFO_SIZE - 1)
4012b556942SAndrew Turner 			count = FIFO_SIZE - 1;
402aa917184SOleksandr Tymoshenko 		size = sndbuf_getsize(play_buf);
403aa917184SOleksandr Tymoshenko 		readyptr = sndbuf_getreadyptr(play_buf);
404aa917184SOleksandr Tymoshenko 
405aa917184SOleksandr Tymoshenko 		samples = (uint8_t*)sndbuf_getbuf(play_buf);
406aa917184SOleksandr Tymoshenko 		written = 0;
4072b556942SAndrew Turner 		for (; level < count; level++) {
408aa917184SOleksandr Tymoshenko 			val  = (samples[readyptr++ % size] << 0);
409aa917184SOleksandr Tymoshenko 			val |= (samples[readyptr++ % size] << 8);
410aa917184SOleksandr Tymoshenko 			val |= (samples[readyptr++ % size] << 16);
411aa917184SOleksandr Tymoshenko 			val |= (samples[readyptr++ % size] << 24);
412aa917184SOleksandr Tymoshenko 			written += 4;
413aa917184SOleksandr Tymoshenko 			RK_I2S_WRITE_4(sc, I2S_TXDR, val);
414aa917184SOleksandr Tymoshenko 		}
415aa917184SOleksandr Tymoshenko 		sc->play_ptr += written;
416aa917184SOleksandr Tymoshenko 		sc->play_ptr %= size;
417aa917184SOleksandr Tymoshenko 		ret |= AUDIO_DAI_PLAY_INTR;
418aa917184SOleksandr Tymoshenko 	}
419aa917184SOleksandr Tymoshenko 
420aa917184SOleksandr Tymoshenko 	if (status & I2S_INTSR_RXFI) {
421aa917184SOleksandr Tymoshenko 		level = RK_I2S_READ_4(sc, I2S_RXFIFOLR) & RXFIFO0LR_MASK;
422aa917184SOleksandr Tymoshenko 		uint8_t *samples;
423aa917184SOleksandr Tymoshenko 		uint32_t count, size, freeptr, recorded;
424aa917184SOleksandr Tymoshenko 		count = sndbuf_getfree(rec_buf);
425aa917184SOleksandr Tymoshenko 		size = sndbuf_getsize(rec_buf);
426aa917184SOleksandr Tymoshenko 		freeptr = sndbuf_getfreeptr(rec_buf);
427aa917184SOleksandr Tymoshenko 		samples = (uint8_t*)sndbuf_getbuf(rec_buf);
428aa917184SOleksandr Tymoshenko 		recorded = 0;
429aa917184SOleksandr Tymoshenko 		if (level > count / 4)
430aa917184SOleksandr Tymoshenko 			level = count / 4;
431aa917184SOleksandr Tymoshenko 
432aa917184SOleksandr Tymoshenko 		for (; level > 0; level--) {
433aa917184SOleksandr Tymoshenko 			val = RK_I2S_READ_4(sc, I2S_RXDR);
434aa917184SOleksandr Tymoshenko 			samples[freeptr++ % size] = val & 0xff;
435aa917184SOleksandr Tymoshenko 			samples[freeptr++ % size] = (val >> 8) & 0xff;
436aa917184SOleksandr Tymoshenko 			samples[freeptr++ % size] = (val >> 16) & 0xff;
437aa917184SOleksandr Tymoshenko 			samples[freeptr++ % size] = (val >> 24) & 0xff;
438aa917184SOleksandr Tymoshenko 			recorded += 4;
439aa917184SOleksandr Tymoshenko 		}
440aa917184SOleksandr Tymoshenko 		sc->rec_ptr += recorded;
441aa917184SOleksandr Tymoshenko 		sc->rec_ptr %= size;
442aa917184SOleksandr Tymoshenko 		ret |= AUDIO_DAI_REC_INTR;
443aa917184SOleksandr Tymoshenko 	}
444aa917184SOleksandr Tymoshenko 
445aa917184SOleksandr Tymoshenko 	RK_I2S_UNLOCK(sc);
446aa917184SOleksandr Tymoshenko 
447aa917184SOleksandr Tymoshenko 	return (ret);
448aa917184SOleksandr Tymoshenko }
449aa917184SOleksandr Tymoshenko 
450aa917184SOleksandr Tymoshenko static struct pcmchan_caps *
rk_i2s_dai_get_caps(device_t dev)451aa917184SOleksandr Tymoshenko rk_i2s_dai_get_caps(device_t dev)
452aa917184SOleksandr Tymoshenko {
453aa917184SOleksandr Tymoshenko 	return (&rk_i2s_caps);
454aa917184SOleksandr Tymoshenko }
455aa917184SOleksandr Tymoshenko 
456aa917184SOleksandr Tymoshenko static int
rk_i2s_dai_trigger(device_t dev,int go,int pcm_dir)457aa917184SOleksandr Tymoshenko rk_i2s_dai_trigger(device_t dev, int go, int pcm_dir)
458aa917184SOleksandr Tymoshenko {
459aa917184SOleksandr Tymoshenko 	struct rk_i2s_softc 	*sc = device_get_softc(dev);
460aa917184SOleksandr Tymoshenko 	uint32_t val;
461aa917184SOleksandr Tymoshenko 	uint32_t clear_bit;
462aa917184SOleksandr Tymoshenko 
463aa917184SOleksandr Tymoshenko 	if ((pcm_dir != PCMDIR_PLAY) && (pcm_dir != PCMDIR_REC))
464aa917184SOleksandr Tymoshenko 		return (EINVAL);
465aa917184SOleksandr Tymoshenko 
466aa917184SOleksandr Tymoshenko 	switch (go) {
467aa917184SOleksandr Tymoshenko 	case PCMTRIG_START:
468aa917184SOleksandr Tymoshenko 		val = RK_I2S_READ_4(sc, I2S_INTCR);
469aa917184SOleksandr Tymoshenko 		if (pcm_dir == PCMDIR_PLAY)
470aa917184SOleksandr Tymoshenko 			val |= I2S_INTCR_TXEIE;
471aa917184SOleksandr Tymoshenko 		else if (pcm_dir == PCMDIR_REC)
472aa917184SOleksandr Tymoshenko 			val |= I2S_INTCR_RXFIE;
473aa917184SOleksandr Tymoshenko 		RK_I2S_WRITE_4(sc, I2S_INTCR, val);
474aa917184SOleksandr Tymoshenko 
475aa917184SOleksandr Tymoshenko 		val = I2S_XFER_TXS_START | I2S_XFER_RXS_START;
476aa917184SOleksandr Tymoshenko 		RK_I2S_WRITE_4(sc, I2S_XFER, val);
477aa917184SOleksandr Tymoshenko 		break;
478aa917184SOleksandr Tymoshenko 
479aa917184SOleksandr Tymoshenko 	case PCMTRIG_STOP:
480aa917184SOleksandr Tymoshenko 	case PCMTRIG_ABORT:
481aa917184SOleksandr Tymoshenko 		val = RK_I2S_READ_4(sc, I2S_INTCR);
482aa917184SOleksandr Tymoshenko 		if (pcm_dir == PCMDIR_PLAY)
483aa917184SOleksandr Tymoshenko 			val &= ~I2S_INTCR_TXEIE;
484aa917184SOleksandr Tymoshenko 		else if (pcm_dir == PCMDIR_REC)
485aa917184SOleksandr Tymoshenko 			val &= ~I2S_INTCR_RXFIE;
486aa917184SOleksandr Tymoshenko 		RK_I2S_WRITE_4(sc, I2S_INTCR, val);
487aa917184SOleksandr Tymoshenko 
488aa917184SOleksandr Tymoshenko 		/*
489aa917184SOleksandr Tymoshenko 		 * If there is no other activity going on, stop transfers
490aa917184SOleksandr Tymoshenko 		 */
491aa917184SOleksandr Tymoshenko 		if ((val & (I2S_INTCR_TXEIE | I2S_INTCR_RXFIE)) == 0) {
492aa917184SOleksandr Tymoshenko 			RK_I2S_WRITE_4(sc, I2S_XFER, 0);
493aa917184SOleksandr Tymoshenko 
494aa917184SOleksandr Tymoshenko 			if (pcm_dir == PCMDIR_PLAY)
495aa917184SOleksandr Tymoshenko 				clear_bit = I2S_CLR_TXC;
496aa917184SOleksandr Tymoshenko 			else if (pcm_dir == PCMDIR_REC)
497aa917184SOleksandr Tymoshenko 				clear_bit = I2S_CLR_RXC;
498aa917184SOleksandr Tymoshenko 			else
499aa917184SOleksandr Tymoshenko 				return (EINVAL);
500aa917184SOleksandr Tymoshenko 
501aa917184SOleksandr Tymoshenko 			val = RK_I2S_READ_4(sc, I2S_CLR);
502aa917184SOleksandr Tymoshenko 			val |= clear_bit;
503aa917184SOleksandr Tymoshenko 			RK_I2S_WRITE_4(sc, I2S_CLR, val);
504aa917184SOleksandr Tymoshenko 
505aa917184SOleksandr Tymoshenko 			while ((RK_I2S_READ_4(sc, I2S_CLR) & clear_bit) != 0)
506aa917184SOleksandr Tymoshenko 				DELAY(1);
507aa917184SOleksandr Tymoshenko 		}
508aa917184SOleksandr Tymoshenko 
509aa917184SOleksandr Tymoshenko 		RK_I2S_LOCK(sc);
510aa917184SOleksandr Tymoshenko 		if (pcm_dir == PCMDIR_PLAY)
511aa917184SOleksandr Tymoshenko 			sc->play_ptr = 0;
512aa917184SOleksandr Tymoshenko 		else
513aa917184SOleksandr Tymoshenko 			sc->rec_ptr = 0;
514aa917184SOleksandr Tymoshenko 		RK_I2S_UNLOCK(sc);
515aa917184SOleksandr Tymoshenko 		break;
516aa917184SOleksandr Tymoshenko 	}
517aa917184SOleksandr Tymoshenko 
518aa917184SOleksandr Tymoshenko 	return (0);
519aa917184SOleksandr Tymoshenko }
520aa917184SOleksandr Tymoshenko 
521aa917184SOleksandr Tymoshenko static uint32_t
rk_i2s_dai_get_ptr(device_t dev,int pcm_dir)522aa917184SOleksandr Tymoshenko rk_i2s_dai_get_ptr(device_t dev, int pcm_dir)
523aa917184SOleksandr Tymoshenko {
524aa917184SOleksandr Tymoshenko 	struct rk_i2s_softc *sc;
525aa917184SOleksandr Tymoshenko 	uint32_t ptr;
526aa917184SOleksandr Tymoshenko 
527aa917184SOleksandr Tymoshenko 	sc = device_get_softc(dev);
528aa917184SOleksandr Tymoshenko 
529aa917184SOleksandr Tymoshenko 	RK_I2S_LOCK(sc);
530aa917184SOleksandr Tymoshenko 	if (pcm_dir == PCMDIR_PLAY)
531aa917184SOleksandr Tymoshenko 		ptr = sc->play_ptr;
532aa917184SOleksandr Tymoshenko 	else
533aa917184SOleksandr Tymoshenko 		ptr = sc->rec_ptr;
534aa917184SOleksandr Tymoshenko 	RK_I2S_UNLOCK(sc);
535aa917184SOleksandr Tymoshenko 
536aa917184SOleksandr Tymoshenko 	return ptr;
537aa917184SOleksandr Tymoshenko }
538aa917184SOleksandr Tymoshenko 
539aa917184SOleksandr Tymoshenko static int
rk_i2s_dai_setup_intr(device_t dev,driver_intr_t intr_handler,void * intr_arg)540aa917184SOleksandr Tymoshenko rk_i2s_dai_setup_intr(device_t dev, driver_intr_t intr_handler, void *intr_arg)
541aa917184SOleksandr Tymoshenko {
542aa917184SOleksandr Tymoshenko 	struct rk_i2s_softc 	*sc = device_get_softc(dev);
543aa917184SOleksandr Tymoshenko 
544aa917184SOleksandr Tymoshenko 	if (bus_setup_intr(dev, sc->res[1],
545*406e959dSAndriy Gapon 	    INTR_TYPE_AV | INTR_MPSAFE, NULL, intr_handler, intr_arg,
546aa917184SOleksandr Tymoshenko 	    &sc->intrhand)) {
547aa917184SOleksandr Tymoshenko 		device_printf(dev, "cannot setup interrupt handler\n");
548aa917184SOleksandr Tymoshenko 		return (ENXIO);
549aa917184SOleksandr Tymoshenko 	}
550aa917184SOleksandr Tymoshenko 
551aa917184SOleksandr Tymoshenko 	return (0);
552aa917184SOleksandr Tymoshenko }
553aa917184SOleksandr Tymoshenko 
554aa917184SOleksandr Tymoshenko static uint32_t
rk_i2s_dai_set_chanformat(device_t dev,uint32_t format)555aa917184SOleksandr Tymoshenko rk_i2s_dai_set_chanformat(device_t dev, uint32_t format)
556aa917184SOleksandr Tymoshenko {
557aa917184SOleksandr Tymoshenko 
558aa917184SOleksandr Tymoshenko 	return (0);
559aa917184SOleksandr Tymoshenko }
560aa917184SOleksandr Tymoshenko 
561aa917184SOleksandr Tymoshenko static int
rk_i2s_dai_set_sysclk(device_t dev,unsigned int rate,int dai_dir)562aa917184SOleksandr Tymoshenko rk_i2s_dai_set_sysclk(device_t dev, unsigned int rate, int dai_dir)
563aa917184SOleksandr Tymoshenko {
564aa917184SOleksandr Tymoshenko 	struct rk_i2s_softc *sc;
565aa917184SOleksandr Tymoshenko 	int error;
566aa917184SOleksandr Tymoshenko 
567aa917184SOleksandr Tymoshenko 	sc = device_get_softc(dev);
568aa917184SOleksandr Tymoshenko 	error = clk_disable(sc->clk);
569aa917184SOleksandr Tymoshenko 	if (error != 0) {
570aa917184SOleksandr Tymoshenko 		device_printf(sc->dev, "could not disable i2s_clk clock\n");
571aa917184SOleksandr Tymoshenko 		return (error);
572aa917184SOleksandr Tymoshenko 	}
573aa917184SOleksandr Tymoshenko 
574aa917184SOleksandr Tymoshenko 	error = clk_set_freq(sc->clk, rate, CLK_SET_ROUND_DOWN);
575aa917184SOleksandr Tymoshenko 	if (error != 0)
576aa917184SOleksandr Tymoshenko 		device_printf(sc->dev, "could not set i2s_clk freq\n");
577aa917184SOleksandr Tymoshenko 
578aa917184SOleksandr Tymoshenko 	error = clk_enable(sc->clk);
579aa917184SOleksandr Tymoshenko 	if (error != 0) {
580aa917184SOleksandr Tymoshenko 		device_printf(sc->dev, "could not enable i2s_clk clock\n");
581aa917184SOleksandr Tymoshenko 		return (error);
582aa917184SOleksandr Tymoshenko 	}
583aa917184SOleksandr Tymoshenko 
584aa917184SOleksandr Tymoshenko 	return (0);
585aa917184SOleksandr Tymoshenko }
586aa917184SOleksandr Tymoshenko 
587aa917184SOleksandr Tymoshenko static uint32_t
rk_i2s_dai_set_chanspeed(device_t dev,uint32_t speed)588aa917184SOleksandr Tymoshenko rk_i2s_dai_set_chanspeed(device_t dev, uint32_t speed)
589aa917184SOleksandr Tymoshenko {
590aa917184SOleksandr Tymoshenko 	struct rk_i2s_softc *sc;
591aa917184SOleksandr Tymoshenko 	int error;
592aa917184SOleksandr Tymoshenko 	uint32_t val;
593aa917184SOleksandr Tymoshenko 	uint32_t bus_clock_div, lr_clock_div;
594aa917184SOleksandr Tymoshenko 	uint64_t bus_clk_freq;
595aa917184SOleksandr Tymoshenko 	uint64_t clk_freq;
596aa917184SOleksandr Tymoshenko 
597aa917184SOleksandr Tymoshenko 	 sc = device_get_softc(dev);
598aa917184SOleksandr Tymoshenko 
599aa917184SOleksandr Tymoshenko 	/* Set format */
600aa917184SOleksandr Tymoshenko 	val = RK_I2S_READ_4(sc, I2S_CKR);
601aa917184SOleksandr Tymoshenko 
602aa917184SOleksandr Tymoshenko 	if ((val & I2S_CKR_MSS_SLAVE) == 0) {
603aa917184SOleksandr Tymoshenko 		error = clk_get_freq(sc->clk, &clk_freq);
604aa917184SOleksandr Tymoshenko 		if (error != 0) {
605aa917184SOleksandr Tymoshenko 			device_printf(sc->dev, "failed to get clk frequency: err=%d\n", error);
606aa917184SOleksandr Tymoshenko 			return (error);
607aa917184SOleksandr Tymoshenko 		}
608aa917184SOleksandr Tymoshenko 		bus_clk_freq = 2 * 32 * speed;
609aa917184SOleksandr Tymoshenko 		bus_clock_div = DIV_ROUND_CLOSEST(clk_freq, bus_clk_freq);
610aa917184SOleksandr Tymoshenko 		lr_clock_div = bus_clk_freq / speed;
611aa917184SOleksandr Tymoshenko 
612aa917184SOleksandr Tymoshenko 		val &= ~(I2S_CKR_MDIV_MASK | I2S_CKR_RSD_MASK | I2S_CKR_TSD_MASK);
613aa917184SOleksandr Tymoshenko 		val |= I2S_CKR_MDIV(bus_clock_div);
614aa917184SOleksandr Tymoshenko 		val |= I2S_CKR_RSD(lr_clock_div);
615aa917184SOleksandr Tymoshenko 		val |= I2S_CKR_TSD(lr_clock_div);
616aa917184SOleksandr Tymoshenko 
617aa917184SOleksandr Tymoshenko 		RK_I2S_WRITE_4(sc, I2S_CKR, val);
618aa917184SOleksandr Tymoshenko 	}
619aa917184SOleksandr Tymoshenko 
620aa917184SOleksandr Tymoshenko 	return (speed);
621aa917184SOleksandr Tymoshenko }
622aa917184SOleksandr Tymoshenko 
623aa917184SOleksandr Tymoshenko static device_method_t rk_i2s_methods[] = {
624aa917184SOleksandr Tymoshenko 	/* Device interface */
625aa917184SOleksandr Tymoshenko 	DEVMETHOD(device_probe,		rk_i2s_probe),
626aa917184SOleksandr Tymoshenko 	DEVMETHOD(device_attach,	rk_i2s_attach),
627aa917184SOleksandr Tymoshenko 	DEVMETHOD(device_detach,	rk_i2s_detach),
628aa917184SOleksandr Tymoshenko 
629aa917184SOleksandr Tymoshenko 	DEVMETHOD(audio_dai_init,	rk_i2s_dai_init),
630aa917184SOleksandr Tymoshenko 	DEVMETHOD(audio_dai_setup_intr,	rk_i2s_dai_setup_intr),
631aa917184SOleksandr Tymoshenko 	DEVMETHOD(audio_dai_set_sysclk,	rk_i2s_dai_set_sysclk),
632aa917184SOleksandr Tymoshenko 	DEVMETHOD(audio_dai_set_chanspeed,	rk_i2s_dai_set_chanspeed),
633aa917184SOleksandr Tymoshenko 	DEVMETHOD(audio_dai_set_chanformat,	rk_i2s_dai_set_chanformat),
634aa917184SOleksandr Tymoshenko 	DEVMETHOD(audio_dai_intr,	rk_i2s_dai_intr),
635aa917184SOleksandr Tymoshenko 	DEVMETHOD(audio_dai_get_caps,	rk_i2s_dai_get_caps),
636aa917184SOleksandr Tymoshenko 	DEVMETHOD(audio_dai_trigger,	rk_i2s_dai_trigger),
637aa917184SOleksandr Tymoshenko 	DEVMETHOD(audio_dai_get_ptr,	rk_i2s_dai_get_ptr),
638aa917184SOleksandr Tymoshenko 
639aa917184SOleksandr Tymoshenko 	DEVMETHOD_END
640aa917184SOleksandr Tymoshenko };
641aa917184SOleksandr Tymoshenko 
642aa917184SOleksandr Tymoshenko static driver_t rk_i2s_driver = {
643aa917184SOleksandr Tymoshenko 	"i2s",
644aa917184SOleksandr Tymoshenko 	rk_i2s_methods,
645aa917184SOleksandr Tymoshenko 	sizeof(struct rk_i2s_softc),
646aa917184SOleksandr Tymoshenko };
647aa917184SOleksandr Tymoshenko 
648b2c1681aSJohn Baldwin DRIVER_MODULE(rk_i2s, simplebus, rk_i2s_driver, 0, 0);
649aa917184SOleksandr Tymoshenko SIMPLEBUS_PNP_INFO(compat_data);
650