rk_i2s.c revision 1.1.2.2
1 1.1.2.2 martin /* $NetBSD: rk_i2s.c,v 1.1.2.2 2019/11/16 16:48:25 martin Exp $ */ 2 1.1.2.2 martin 3 1.1.2.2 martin /*- 4 1.1.2.2 martin * Copyright (c) 2019 Jared McNeill <jmcneill (at) invisible.ca> 5 1.1.2.2 martin * All rights reserved. 6 1.1.2.2 martin * 7 1.1.2.2 martin * Redistribution and use in source and binary forms, with or without 8 1.1.2.2 martin * modification, are permitted provided that the following conditions 9 1.1.2.2 martin * are met: 10 1.1.2.2 martin * 1. Redistributions of source code must retain the above copyright 11 1.1.2.2 martin * notice, this list of conditions and the following disclaimer. 12 1.1.2.2 martin * 2. Redistributions in binary form must reproduce the above copyright 13 1.1.2.2 martin * notice, this list of conditions and the following disclaimer in the 14 1.1.2.2 martin * documentation and/or other materials provided with the distribution. 15 1.1.2.2 martin * 16 1.1.2.2 martin * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 1.1.2.2 martin * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18 1.1.2.2 martin * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19 1.1.2.2 martin * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 20 1.1.2.2 martin * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 21 1.1.2.2 martin * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 22 1.1.2.2 martin * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 23 1.1.2.2 martin * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 24 1.1.2.2 martin * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 1.1.2.2 martin * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 1.1.2.2 martin * SUCH DAMAGE. 27 1.1.2.2 martin */ 28 1.1.2.2 martin 29 1.1.2.2 martin #include <sys/cdefs.h> 30 1.1.2.2 martin __KERNEL_RCSID(0, "$NetBSD: rk_i2s.c,v 1.1.2.2 2019/11/16 16:48:25 martin Exp $"); 31 1.1.2.2 martin 32 1.1.2.2 martin #include <sys/param.h> 33 1.1.2.2 martin #include <sys/bus.h> 34 1.1.2.2 martin #include <sys/cpu.h> 35 1.1.2.2 martin #include <sys/device.h> 36 1.1.2.2 martin #include <sys/kmem.h> 37 1.1.2.2 martin 38 1.1.2.2 martin #include <sys/audioio.h> 39 1.1.2.2 martin #include <dev/audio/audio_if.h> 40 1.1.2.2 martin #include <dev/audio/linear.h> 41 1.1.2.2 martin 42 1.1.2.2 martin #include <dev/fdt/fdtvar.h> 43 1.1.2.2 martin #include <dev/fdt/syscon.h> 44 1.1.2.2 martin 45 1.1.2.2 martin #define RK_I2S_FIFO_DEPTH 32 46 1.1.2.2 martin #define RK_I2S_SAMPLE_RATE 48000 47 1.1.2.2 martin 48 1.1.2.2 martin #define I2S_TXCR 0x00 49 1.1.2.2 martin #define TXCR_RCNT __BITS(22,17) 50 1.1.2.2 martin #define TXCR_TCSR __BITS(16,15) 51 1.1.2.2 martin #define TXCR_HWT __BIT(14) 52 1.1.2.2 martin #define TXCR_SJM __BIT(12) 53 1.1.2.2 martin #define TXCR_FBM __BIT(11) 54 1.1.2.2 martin #define TXCR_IBM __BITS(10,9) 55 1.1.2.2 martin #define TXCR_PBM __BITS(8,7) 56 1.1.2.2 martin #define TXCR_TFS __BIT(5) 57 1.1.2.2 martin #define TXCR_VDW __BITS(4,0) 58 1.1.2.2 martin #define I2S_RXCR 0x04 59 1.1.2.2 martin #define RXCR_RCSR __BITS(16,15) 60 1.1.2.2 martin #define RXCR_HWT __BIT(14) 61 1.1.2.2 martin #define RXCR_SJM __BIT(12) 62 1.1.2.2 martin #define RXCR_FBM __BIT(11) 63 1.1.2.2 martin #define RXCR_IBM __BITS(10,9) 64 1.1.2.2 martin #define RXCR_PBM __BITS(8,7) 65 1.1.2.2 martin #define RXCR_TFS __BIT(5) 66 1.1.2.2 martin #define RXCR_VDW __BITS(4,0) 67 1.1.2.2 martin #define I2S_CKR 0x08 68 1.1.2.2 martin #define CKR_TRCM __BITS(29,28) 69 1.1.2.2 martin #define CKR_MSS __BIT(27) 70 1.1.2.2 martin #define CKR_CKP __BIT(26) 71 1.1.2.2 martin #define CKR_RLP __BIT(25) 72 1.1.2.2 martin #define CKR_TLP __BIT(24) 73 1.1.2.2 martin #define CKR_MDIV __BITS(23,16) 74 1.1.2.2 martin #define CKR_RSD __BITS(15,8) 75 1.1.2.2 martin #define CKR_TSD __BITS(7,0) 76 1.1.2.2 martin #define I2S_TXFIFOLR 0x0c 77 1.1.2.2 martin #define TXFIFOLR_TFL(n) __BITS((n) * 6 + 5, (n) * 6) 78 1.1.2.2 martin #define I2S_DMACR 0x10 79 1.1.2.2 martin #define DMACR_RDE __BIT(24) 80 1.1.2.2 martin #define DMACR_RDL __BITS(20,16) 81 1.1.2.2 martin #define DMACR_TDE __BIT(8) 82 1.1.2.2 martin #define DMACR_TDL __BITS(4,0) 83 1.1.2.2 martin #define I2S_INTCR 0x14 84 1.1.2.2 martin #define INTCR_RFT __BITS(24,20) 85 1.1.2.2 martin #define INTCR_RXOIC __BIT(18) 86 1.1.2.2 martin #define INTCR_RXOIE __BIT(17) 87 1.1.2.2 martin #define INTCR_RXFIE __BIT(16) 88 1.1.2.2 martin #define INTCR_TFT __BITS(8,4) 89 1.1.2.2 martin #define INTCR_TXUIC __BIT(2) 90 1.1.2.2 martin #define INTCR_TXUIE __BIT(1) 91 1.1.2.2 martin #define INTCR_TXEIE __BIT(0) 92 1.1.2.2 martin #define I2S_INTSR 0x18 93 1.1.2.2 martin #define INTSR_RXOI __BIT(17) 94 1.1.2.2 martin #define INTSR_RXFI __BIT(16) 95 1.1.2.2 martin #define INTSR_TXUI __BIT(1) 96 1.1.2.2 martin #define INTSR_TXEI __BIT(0) 97 1.1.2.2 martin #define I2S_XFER 0x1c 98 1.1.2.2 martin #define XFER_RXS __BIT(1) 99 1.1.2.2 martin #define XFER_TXS __BIT(0) 100 1.1.2.2 martin #define I2S_CLR 0x20 101 1.1.2.2 martin #define CLR_RXC __BIT(1) 102 1.1.2.2 martin #define CLR_TXC __BIT(0) 103 1.1.2.2 martin #define I2S_TXDR 0x24 104 1.1.2.2 martin #define I2S_RXDR 0x28 105 1.1.2.2 martin #define I2S_RXFIFOLR 0x2c 106 1.1.2.2 martin #define RXFIFOLR_RFL(n) __BITS((n) * 6 + 5, (n) * 6) 107 1.1.2.2 martin 108 1.1.2.2 martin struct rk_i2s_config { 109 1.1.2.2 martin bus_size_t oe_reg; 110 1.1.2.2 martin u_int oe_mask; 111 1.1.2.2 martin u_int oe_val; 112 1.1.2.2 martin }; 113 1.1.2.2 martin 114 1.1.2.2 martin static const struct rk_i2s_config rk3399_i2s_config = { 115 1.1.2.2 martin .oe_reg = 0x0e220, 116 1.1.2.2 martin .oe_mask = __BITS(13,11), 117 1.1.2.2 martin .oe_val = 0x7, 118 1.1.2.2 martin }; 119 1.1.2.2 martin 120 1.1.2.2 martin static const struct of_compat_data compat_data[] = { 121 1.1.2.2 martin { "rockchip,rk3399-i2s", (uintptr_t)&rk3399_i2s_config }, 122 1.1.2.2 martin { NULL } 123 1.1.2.2 martin }; 124 1.1.2.2 martin 125 1.1.2.2 martin struct rk_i2s_softc; 126 1.1.2.2 martin 127 1.1.2.2 martin struct rk_i2s_chan { 128 1.1.2.2 martin uint32_t *ch_start; 129 1.1.2.2 martin uint32_t *ch_end; 130 1.1.2.2 martin uint32_t *ch_cur; 131 1.1.2.2 martin 132 1.1.2.2 martin int ch_blksize; 133 1.1.2.2 martin int ch_resid; 134 1.1.2.2 martin 135 1.1.2.2 martin void (*ch_intr)(void *); 136 1.1.2.2 martin void *ch_intrarg; 137 1.1.2.2 martin }; 138 1.1.2.2 martin 139 1.1.2.2 martin struct rk_i2s_softc { 140 1.1.2.2 martin device_t sc_dev; 141 1.1.2.2 martin bus_space_tag_t sc_bst; 142 1.1.2.2 martin bus_space_handle_t sc_bsh; 143 1.1.2.2 martin int sc_phandle; 144 1.1.2.2 martin struct clk *sc_clk; 145 1.1.2.2 martin struct syscon *sc_grf; 146 1.1.2.2 martin const struct rk_i2s_config *sc_conf; 147 1.1.2.2 martin 148 1.1.2.2 martin kmutex_t sc_lock; 149 1.1.2.2 martin kmutex_t sc_intr_lock; 150 1.1.2.2 martin 151 1.1.2.2 martin struct audio_format sc_format; 152 1.1.2.2 martin 153 1.1.2.2 martin struct rk_i2s_chan sc_pchan; 154 1.1.2.2 martin struct rk_i2s_chan sc_rchan; 155 1.1.2.2 martin 156 1.1.2.2 martin u_int sc_active; 157 1.1.2.2 martin 158 1.1.2.2 martin struct audio_dai_device sc_dai; 159 1.1.2.2 martin }; 160 1.1.2.2 martin 161 1.1.2.2 martin #define RD4(sc, reg) \ 162 1.1.2.2 martin bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg)) 163 1.1.2.2 martin #define WR4(sc, reg, val) \ 164 1.1.2.2 martin bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val)) 165 1.1.2.2 martin 166 1.1.2.2 martin static int 167 1.1.2.2 martin rk_i2s_query_format(void *priv, audio_format_query_t *afp) 168 1.1.2.2 martin { 169 1.1.2.2 martin struct rk_i2s_softc * const sc = priv; 170 1.1.2.2 martin 171 1.1.2.2 martin return audio_query_format(&sc->sc_format, 1, afp); 172 1.1.2.2 martin } 173 1.1.2.2 martin 174 1.1.2.2 martin static int 175 1.1.2.2 martin rk_i2s_set_format(void *priv, int setmode, 176 1.1.2.2 martin const audio_params_t *play, const audio_params_t *rec, 177 1.1.2.2 martin audio_filter_reg_t *pfil, audio_filter_reg_t *rfil) 178 1.1.2.2 martin { 179 1.1.2.2 martin struct rk_i2s_softc * const sc = priv; 180 1.1.2.2 martin uint32_t ckr, txcr, rxcr; 181 1.1.2.2 martin 182 1.1.2.2 martin ckr = RD4(sc, I2S_CKR); 183 1.1.2.2 martin if ((ckr & CKR_MSS) == 0) { 184 1.1.2.2 martin const u_int mclk_rate = clk_get_rate(sc->sc_clk); 185 1.1.2.2 martin device_printf(sc->sc_dev, "%s: sysclk rate %u Hz\n", __func__, mclk_rate); 186 1.1.2.2 martin const u_int bclk_rate = 2 * 32 * RK_I2S_SAMPLE_RATE; 187 1.1.2.2 martin const u_int bclk_div = mclk_rate / bclk_rate; 188 1.1.2.2 martin const u_int lrck_div = bclk_rate / RK_I2S_SAMPLE_RATE; 189 1.1.2.2 martin 190 1.1.2.2 martin ckr &= ~CKR_MDIV; 191 1.1.2.2 martin ckr |= __SHIFTIN(bclk_div - 1, CKR_MDIV); 192 1.1.2.2 martin ckr &= ~CKR_TSD; 193 1.1.2.2 martin ckr |= __SHIFTIN(lrck_div - 1, CKR_TSD); 194 1.1.2.2 martin ckr &= ~CKR_RSD; 195 1.1.2.2 martin ckr |= __SHIFTIN(lrck_div - 1, CKR_RSD); 196 1.1.2.2 martin } 197 1.1.2.2 martin 198 1.1.2.2 martin ckr &= ~CKR_TRCM; 199 1.1.2.2 martin ckr |= __SHIFTIN(0, CKR_TRCM); 200 1.1.2.2 martin WR4(sc, I2S_CKR, ckr); 201 1.1.2.2 martin 202 1.1.2.2 martin if (play && (setmode & AUMODE_PLAY) != 0) { 203 1.1.2.2 martin if (play->channels & 1) 204 1.1.2.2 martin return EINVAL; 205 1.1.2.2 martin txcr = RD4(sc, I2S_TXCR); 206 1.1.2.2 martin txcr &= ~TXCR_VDW; 207 1.1.2.2 martin txcr |= __SHIFTIN(play->validbits - 1, TXCR_VDW); 208 1.1.2.2 martin txcr &= ~TXCR_TCSR; 209 1.1.2.2 martin txcr |= __SHIFTIN(play->channels / 2 - 1, TXCR_TCSR); 210 1.1.2.2 martin WR4(sc, I2S_TXCR, txcr); 211 1.1.2.2 martin } 212 1.1.2.2 martin 213 1.1.2.2 martin if (rec && (setmode & AUMODE_RECORD) != 0) { 214 1.1.2.2 martin if (rec->channels & 1) 215 1.1.2.2 martin return EINVAL; 216 1.1.2.2 martin rxcr = RD4(sc, I2S_RXCR); 217 1.1.2.2 martin rxcr &= ~RXCR_VDW; 218 1.1.2.2 martin rxcr |= __SHIFTIN(rec->validbits - 1, RXCR_VDW); 219 1.1.2.2 martin rxcr &= ~RXCR_RCSR; 220 1.1.2.2 martin rxcr |= __SHIFTIN(rec->channels / 2 - 1, RXCR_RCSR); 221 1.1.2.2 martin WR4(sc, I2S_RXCR, rxcr); 222 1.1.2.2 martin } 223 1.1.2.2 martin 224 1.1.2.2 martin return 0; 225 1.1.2.2 martin } 226 1.1.2.2 martin 227 1.1.2.2 martin static int 228 1.1.2.2 martin rk_i2s_get_props(void *priv) 229 1.1.2.2 martin { 230 1.1.2.2 martin 231 1.1.2.2 martin return AUDIO_PROP_PLAYBACK | AUDIO_PROP_CAPTURE | 232 1.1.2.2 martin AUDIO_PROP_FULLDUPLEX; 233 1.1.2.2 martin } 234 1.1.2.2 martin 235 1.1.2.2 martin static int 236 1.1.2.2 martin rk_i2s_round_blocksize(void *priv, int bs, int mode, 237 1.1.2.2 martin const audio_params_t *params) 238 1.1.2.2 martin { 239 1.1.2.2 martin bs &= ~3; 240 1.1.2.2 martin if (bs == 0) 241 1.1.2.2 martin bs = 4; 242 1.1.2.2 martin return bs; 243 1.1.2.2 martin } 244 1.1.2.2 martin 245 1.1.2.2 martin static void * 246 1.1.2.2 martin rk_i2s_allocm(void *priv, int dir, size_t size) 247 1.1.2.2 martin { 248 1.1.2.2 martin return kmem_zalloc(size, KM_SLEEP); 249 1.1.2.2 martin } 250 1.1.2.2 martin 251 1.1.2.2 martin static void 252 1.1.2.2 martin rk_i2s_freem(void *priv, void *addr, size_t size) 253 1.1.2.2 martin { 254 1.1.2.2 martin kmem_free(addr, size); 255 1.1.2.2 martin } 256 1.1.2.2 martin 257 1.1.2.2 martin static int 258 1.1.2.2 martin rk_i2s_trigger_output(void *priv, void *start, void *end, int blksize, 259 1.1.2.2 martin void (*intr)(void *), void *intrarg, const audio_params_t *params) 260 1.1.2.2 martin { 261 1.1.2.2 martin struct rk_i2s_softc * const sc = priv; 262 1.1.2.2 martin struct rk_i2s_chan *ch = &sc->sc_pchan; 263 1.1.2.2 martin uint32_t val; 264 1.1.2.2 martin 265 1.1.2.2 martin if (sc->sc_active == 0) { 266 1.1.2.2 martin val = RD4(sc, I2S_XFER); 267 1.1.2.2 martin val |= (XFER_TXS | XFER_RXS); 268 1.1.2.2 martin WR4(sc, I2S_XFER, val); 269 1.1.2.2 martin } 270 1.1.2.2 martin 271 1.1.2.2 martin sc->sc_active |= XFER_TXS; 272 1.1.2.2 martin 273 1.1.2.2 martin val = RD4(sc, I2S_INTCR); 274 1.1.2.2 martin val |= INTCR_TXEIE; 275 1.1.2.2 martin val &= ~INTCR_TFT; 276 1.1.2.2 martin val |= __SHIFTIN(RK_I2S_FIFO_DEPTH / 2, INTCR_TFT); 277 1.1.2.2 martin WR4(sc, I2S_INTCR, val); 278 1.1.2.2 martin 279 1.1.2.2 martin ch->ch_intr = intr; 280 1.1.2.2 martin ch->ch_intrarg = intrarg; 281 1.1.2.2 martin ch->ch_start = ch->ch_cur = start; 282 1.1.2.2 martin ch->ch_end = end; 283 1.1.2.2 martin ch->ch_blksize = blksize; 284 1.1.2.2 martin ch->ch_resid = blksize; 285 1.1.2.2 martin 286 1.1.2.2 martin return 0; 287 1.1.2.2 martin } 288 1.1.2.2 martin 289 1.1.2.2 martin static int 290 1.1.2.2 martin rk_i2s_trigger_input(void *priv, void *start, void *end, int blksize, 291 1.1.2.2 martin void (*intr)(void *), void *intrarg, const audio_params_t *params) 292 1.1.2.2 martin { 293 1.1.2.2 martin return EIO; 294 1.1.2.2 martin } 295 1.1.2.2 martin 296 1.1.2.2 martin static int 297 1.1.2.2 martin rk_i2s_halt_output(void *priv) 298 1.1.2.2 martin { 299 1.1.2.2 martin struct rk_i2s_softc * const sc = priv; 300 1.1.2.2 martin struct rk_i2s_chan *ch = &sc->sc_pchan; 301 1.1.2.2 martin uint32_t val; 302 1.1.2.2 martin 303 1.1.2.2 martin sc->sc_active &= ~XFER_TXS; 304 1.1.2.2 martin if (sc->sc_active == 0) { 305 1.1.2.2 martin val = RD4(sc, I2S_XFER); 306 1.1.2.2 martin val &= ~(XFER_TXS|XFER_RXS); 307 1.1.2.2 martin WR4(sc, I2S_XFER, val); 308 1.1.2.2 martin } 309 1.1.2.2 martin 310 1.1.2.2 martin val = RD4(sc, I2S_INTCR); 311 1.1.2.2 martin val &= ~INTCR_TXEIE; 312 1.1.2.2 martin WR4(sc, I2S_INTCR, val); 313 1.1.2.2 martin 314 1.1.2.2 martin val = RD4(sc, I2S_CLR); 315 1.1.2.2 martin val |= CLR_TXC; 316 1.1.2.2 martin WR4(sc, I2S_CLR, val); 317 1.1.2.2 martin 318 1.1.2.2 martin while ((RD4(sc, I2S_CLR) & CLR_TXC) != 0) 319 1.1.2.2 martin delay(1); 320 1.1.2.2 martin 321 1.1.2.2 martin ch->ch_intr = NULL; 322 1.1.2.2 martin ch->ch_intrarg = NULL; 323 1.1.2.2 martin 324 1.1.2.2 martin return 0; 325 1.1.2.2 martin } 326 1.1.2.2 martin 327 1.1.2.2 martin static int 328 1.1.2.2 martin rk_i2s_halt_input(void *priv) 329 1.1.2.2 martin { 330 1.1.2.2 martin struct rk_i2s_softc * const sc = priv; 331 1.1.2.2 martin struct rk_i2s_chan *ch = &sc->sc_rchan; 332 1.1.2.2 martin uint32_t val; 333 1.1.2.2 martin 334 1.1.2.2 martin sc->sc_active &= ~XFER_RXS; 335 1.1.2.2 martin if (sc->sc_active == 0) { 336 1.1.2.2 martin val = RD4(sc, I2S_XFER); 337 1.1.2.2 martin val &= ~(XFER_TXS|XFER_RXS); 338 1.1.2.2 martin WR4(sc, I2S_XFER, val); 339 1.1.2.2 martin } 340 1.1.2.2 martin 341 1.1.2.2 martin val = RD4(sc, I2S_INTCR); 342 1.1.2.2 martin val &= ~INTCR_RXFIE; 343 1.1.2.2 martin WR4(sc, I2S_INTCR, val); 344 1.1.2.2 martin 345 1.1.2.2 martin ch->ch_intr = NULL; 346 1.1.2.2 martin ch->ch_intrarg = NULL; 347 1.1.2.2 martin 348 1.1.2.2 martin return 0; 349 1.1.2.2 martin } 350 1.1.2.2 martin 351 1.1.2.2 martin static void 352 1.1.2.2 martin rk_i2s_get_locks(void *priv, kmutex_t **intr, kmutex_t **thread) 353 1.1.2.2 martin { 354 1.1.2.2 martin struct rk_i2s_softc * const sc = priv; 355 1.1.2.2 martin 356 1.1.2.2 martin *intr = &sc->sc_intr_lock; 357 1.1.2.2 martin *thread = &sc->sc_lock; 358 1.1.2.2 martin } 359 1.1.2.2 martin 360 1.1.2.2 martin static const struct audio_hw_if rk_i2s_hw_if = { 361 1.1.2.2 martin .query_format = rk_i2s_query_format, 362 1.1.2.2 martin .set_format = rk_i2s_set_format, 363 1.1.2.2 martin .get_props = rk_i2s_get_props, 364 1.1.2.2 martin .round_blocksize = rk_i2s_round_blocksize, 365 1.1.2.2 martin .allocm = rk_i2s_allocm, 366 1.1.2.2 martin .freem = rk_i2s_freem, 367 1.1.2.2 martin .trigger_output = rk_i2s_trigger_output, 368 1.1.2.2 martin .trigger_input = rk_i2s_trigger_input, 369 1.1.2.2 martin .halt_output = rk_i2s_halt_output, 370 1.1.2.2 martin .halt_input = rk_i2s_halt_input, 371 1.1.2.2 martin .get_locks = rk_i2s_get_locks, 372 1.1.2.2 martin }; 373 1.1.2.2 martin 374 1.1.2.2 martin static int 375 1.1.2.2 martin rk_i2s_intr(void *priv) 376 1.1.2.2 martin { 377 1.1.2.2 martin struct rk_i2s_softc * const sc = priv; 378 1.1.2.2 martin struct rk_i2s_chan * const pch = &sc->sc_pchan; 379 1.1.2.2 martin #if notyet 380 1.1.2.2 martin struct rk_i2s_chan * const rch = &sc->sc_rchan; 381 1.1.2.2 martin #endif 382 1.1.2.2 martin uint32_t sr, val; 383 1.1.2.2 martin int fifolr; 384 1.1.2.2 martin 385 1.1.2.2 martin mutex_enter(&sc->sc_intr_lock); 386 1.1.2.2 martin 387 1.1.2.2 martin sr = RD4(sc, I2S_INTSR); 388 1.1.2.2 martin 389 1.1.2.2 martin if ((sr & INTSR_RXFI) != 0) { 390 1.1.2.2 martin #if notyet 391 1.1.2.2 martin val = RD4(sc, I2S_RXFIFOLR); 392 1.1.2.2 martin fifolr = __SHIFTOUT(val, RXFIFOLR_RFL(0)); 393 1.1.2.2 martin while (fifolr > 0) { 394 1.1.2.2 martin *rch->ch_data = RD4(sc, I2S_RXDR); 395 1.1.2.2 martin rch->ch_data++; 396 1.1.2.2 martin rch->ch_resid -= 4; 397 1.1.2.2 martin if (rch->ch_resid == 0) 398 1.1.2.2 martin rch->ch_intr(rch->ch_intrarg); 399 1.1.2.2 martin --fifolr; 400 1.1.2.2 martin } 401 1.1.2.2 martin #endif 402 1.1.2.2 martin } 403 1.1.2.2 martin 404 1.1.2.2 martin if ((sr & INTSR_TXEI) != 0) { 405 1.1.2.2 martin val = RD4(sc, I2S_TXFIFOLR); 406 1.1.2.2 martin fifolr = __SHIFTOUT(val, TXFIFOLR_TFL(0)); 407 1.1.2.2 martin fifolr = uimin(fifolr, RK_I2S_FIFO_DEPTH); 408 1.1.2.2 martin while (fifolr < RK_I2S_FIFO_DEPTH - 1) { 409 1.1.2.2 martin WR4(sc, I2S_TXDR, *pch->ch_cur); 410 1.1.2.2 martin pch->ch_cur++; 411 1.1.2.2 martin if (pch->ch_cur == pch->ch_end) 412 1.1.2.2 martin pch->ch_cur = pch->ch_start; 413 1.1.2.2 martin pch->ch_resid -= 4; 414 1.1.2.2 martin if (pch->ch_resid == 0) { 415 1.1.2.2 martin pch->ch_intr(pch->ch_intrarg); 416 1.1.2.2 martin pch->ch_resid = pch->ch_blksize; 417 1.1.2.2 martin } 418 1.1.2.2 martin ++fifolr; 419 1.1.2.2 martin } 420 1.1.2.2 martin } 421 1.1.2.2 martin 422 1.1.2.2 martin mutex_exit(&sc->sc_intr_lock); 423 1.1.2.2 martin 424 1.1.2.2 martin return 0; 425 1.1.2.2 martin } 426 1.1.2.2 martin 427 1.1.2.2 martin static int 428 1.1.2.2 martin rk_i2s_dai_set_sysclk(audio_dai_tag_t dai, u_int rate, int dir) 429 1.1.2.2 martin { 430 1.1.2.2 martin struct rk_i2s_softc * const sc = audio_dai_private(dai); 431 1.1.2.2 martin int error; 432 1.1.2.2 martin 433 1.1.2.2 martin device_printf(sc->sc_dev, "set sysclk %u Hz\n", rate); 434 1.1.2.2 martin error = clk_set_rate(sc->sc_clk, rate); 435 1.1.2.2 martin if (error != 0) { 436 1.1.2.2 martin device_printf(sc->sc_dev, "failed to set sysclk to %u Hz: %d\n", 437 1.1.2.2 martin rate, error); 438 1.1.2.2 martin return error; 439 1.1.2.2 martin } 440 1.1.2.2 martin 441 1.1.2.2 martin return 0; 442 1.1.2.2 martin } 443 1.1.2.2 martin 444 1.1.2.2 martin static int 445 1.1.2.2 martin rk_i2s_dai_set_format(audio_dai_tag_t dai, u_int format) 446 1.1.2.2 martin { 447 1.1.2.2 martin struct rk_i2s_softc * const sc = audio_dai_private(dai); 448 1.1.2.2 martin uint32_t txcr, rxcr, ckr; 449 1.1.2.2 martin 450 1.1.2.2 martin const u_int fmt = __SHIFTOUT(format, AUDIO_DAI_FORMAT_MASK); 451 1.1.2.2 martin const u_int pol = __SHIFTOUT(format, AUDIO_DAI_POLARITY_MASK); 452 1.1.2.2 martin const u_int clk = __SHIFTOUT(format, AUDIO_DAI_CLOCK_MASK); 453 1.1.2.2 martin 454 1.1.2.2 martin txcr = RD4(sc, I2S_TXCR); 455 1.1.2.2 martin rxcr = RD4(sc, I2S_RXCR); 456 1.1.2.2 martin ckr = RD4(sc, I2S_CKR); 457 1.1.2.2 martin 458 1.1.2.2 martin txcr &= ~(TXCR_IBM|TXCR_PBM|TXCR_TFS); 459 1.1.2.2 martin rxcr &= ~(RXCR_IBM|RXCR_PBM|RXCR_TFS); 460 1.1.2.2 martin switch (fmt) { 461 1.1.2.2 martin case AUDIO_DAI_FORMAT_I2S: 462 1.1.2.2 martin txcr |= __SHIFTIN(0, TXCR_IBM); 463 1.1.2.2 martin rxcr |= __SHIFTIN(0, RXCR_IBM); 464 1.1.2.2 martin break; 465 1.1.2.2 martin case AUDIO_DAI_FORMAT_LJ: 466 1.1.2.2 martin txcr |= __SHIFTIN(1, TXCR_IBM); 467 1.1.2.2 martin rxcr |= __SHIFTIN(1, RXCR_IBM); 468 1.1.2.2 martin break; 469 1.1.2.2 martin case AUDIO_DAI_FORMAT_RJ: 470 1.1.2.2 martin txcr |= __SHIFTIN(2, TXCR_IBM); 471 1.1.2.2 martin rxcr |= __SHIFTIN(2, RXCR_IBM); 472 1.1.2.2 martin break; 473 1.1.2.2 martin case AUDIO_DAI_FORMAT_DSPA: 474 1.1.2.2 martin txcr |= __SHIFTIN(0, TXCR_PBM); 475 1.1.2.2 martin txcr |= TXCR_TFS; 476 1.1.2.2 martin rxcr |= __SHIFTIN(0, RXCR_PBM); 477 1.1.2.2 martin txcr |= RXCR_TFS; 478 1.1.2.2 martin break; 479 1.1.2.2 martin case AUDIO_DAI_FORMAT_DSPB: 480 1.1.2.2 martin txcr |= __SHIFTIN(1, TXCR_PBM); 481 1.1.2.2 martin txcr |= TXCR_TFS; 482 1.1.2.2 martin rxcr |= __SHIFTIN(1, RXCR_PBM); 483 1.1.2.2 martin txcr |= RXCR_TFS; 484 1.1.2.2 martin break; 485 1.1.2.2 martin default: 486 1.1.2.2 martin return EINVAL; 487 1.1.2.2 martin } 488 1.1.2.2 martin 489 1.1.2.2 martin WR4(sc, I2S_TXCR, txcr); 490 1.1.2.2 martin WR4(sc, I2S_RXCR, rxcr); 491 1.1.2.2 martin 492 1.1.2.2 martin switch (pol) { 493 1.1.2.2 martin case AUDIO_DAI_POLARITY_IB_NF: 494 1.1.2.2 martin ckr |= CKR_CKP; 495 1.1.2.2 martin break; 496 1.1.2.2 martin case AUDIO_DAI_POLARITY_NB_NF: 497 1.1.2.2 martin ckr &= ~CKR_CKP; 498 1.1.2.2 martin break; 499 1.1.2.2 martin default: 500 1.1.2.2 martin return EINVAL; 501 1.1.2.2 martin } 502 1.1.2.2 martin 503 1.1.2.2 martin switch (clk) { 504 1.1.2.2 martin case AUDIO_DAI_CLOCK_CBM_CFM: 505 1.1.2.2 martin ckr |= CKR_MSS; /* sclk input */ 506 1.1.2.2 martin break; 507 1.1.2.2 martin case AUDIO_DAI_CLOCK_CBS_CFS: 508 1.1.2.2 martin ckr &= ~CKR_MSS; /* sclk output */ 509 1.1.2.2 martin break; 510 1.1.2.2 martin default: 511 1.1.2.2 martin return EINVAL; 512 1.1.2.2 martin } 513 1.1.2.2 martin 514 1.1.2.2 martin WR4(sc, I2S_CKR, ckr); 515 1.1.2.2 martin 516 1.1.2.2 martin return 0; 517 1.1.2.2 martin } 518 1.1.2.2 martin 519 1.1.2.2 martin static audio_dai_tag_t 520 1.1.2.2 martin rk_i2s_dai_get_tag(device_t dev, const void *data, size_t len) 521 1.1.2.2 martin { 522 1.1.2.2 martin struct rk_i2s_softc * const sc = device_private(dev); 523 1.1.2.2 martin 524 1.1.2.2 martin if (len != 4) 525 1.1.2.2 martin return NULL; 526 1.1.2.2 martin 527 1.1.2.2 martin return &sc->sc_dai; 528 1.1.2.2 martin } 529 1.1.2.2 martin 530 1.1.2.2 martin static struct fdtbus_dai_controller_func rk_i2s_dai_funcs = { 531 1.1.2.2 martin .get_tag = rk_i2s_dai_get_tag 532 1.1.2.2 martin }; 533 1.1.2.2 martin 534 1.1.2.2 martin static int 535 1.1.2.2 martin rk_i2s_clock_init(struct rk_i2s_softc *sc) 536 1.1.2.2 martin { 537 1.1.2.2 martin const int phandle = sc->sc_phandle; 538 1.1.2.2 martin int error; 539 1.1.2.2 martin 540 1.1.2.2 martin sc->sc_clk = fdtbus_clock_get(phandle, "i2s_clk"); 541 1.1.2.2 martin if (sc->sc_clk == NULL) { 542 1.1.2.2 martin aprint_error(": couldn't find i2s_clk clock\n"); 543 1.1.2.2 martin return ENXIO; 544 1.1.2.2 martin } 545 1.1.2.2 martin error = clk_enable(sc->sc_clk); 546 1.1.2.2 martin if (error != 0) { 547 1.1.2.2 martin aprint_error(": couldn't enable i2s_clk clock: %d\n", error); 548 1.1.2.2 martin return error; 549 1.1.2.2 martin } 550 1.1.2.2 martin 551 1.1.2.2 martin /* Enable bus clock */ 552 1.1.2.2 martin if (fdtbus_clock_enable(phandle, "i2s_hclk", true) != 0) { 553 1.1.2.2 martin aprint_error(": couldn't enable i2s_hclk clock: %d\n", error); 554 1.1.2.2 martin return error; 555 1.1.2.2 martin } 556 1.1.2.2 martin 557 1.1.2.2 martin return 0; 558 1.1.2.2 martin } 559 1.1.2.2 martin 560 1.1.2.2 martin static int 561 1.1.2.2 martin rk_i2s_match(device_t parent, cfdata_t cf, void *aux) 562 1.1.2.2 martin { 563 1.1.2.2 martin struct fdt_attach_args * const faa = aux; 564 1.1.2.2 martin 565 1.1.2.2 martin return of_match_compat_data(faa->faa_phandle, compat_data); 566 1.1.2.2 martin } 567 1.1.2.2 martin 568 1.1.2.2 martin static void 569 1.1.2.2 martin rk_i2s_attach(device_t parent, device_t self, void *aux) 570 1.1.2.2 martin { 571 1.1.2.2 martin struct rk_i2s_softc * const sc = device_private(self); 572 1.1.2.2 martin struct fdt_attach_args * const faa = aux; 573 1.1.2.2 martin const int phandle = faa->faa_phandle; 574 1.1.2.2 martin char intrstr[128]; 575 1.1.2.2 martin bus_addr_t addr; 576 1.1.2.2 martin bus_size_t size; 577 1.1.2.2 martin uint32_t val; 578 1.1.2.2 martin 579 1.1.2.2 martin if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) { 580 1.1.2.2 martin aprint_error(": couldn't get registers\n"); 581 1.1.2.2 martin return; 582 1.1.2.2 martin } 583 1.1.2.2 martin if (!fdtbus_intr_str(phandle, 0, intrstr, sizeof(intrstr))) { 584 1.1.2.2 martin aprint_error(": couldn't decode interrupt\n"); 585 1.1.2.2 martin return; 586 1.1.2.2 martin } 587 1.1.2.2 martin 588 1.1.2.2 martin sc->sc_dev = self; 589 1.1.2.2 martin sc->sc_phandle = phandle; 590 1.1.2.2 martin sc->sc_bst = faa->faa_bst; 591 1.1.2.2 martin if (bus_space_map(sc->sc_bst, addr, size, 0, &sc->sc_bsh) != 0) { 592 1.1.2.2 martin aprint_error(": couldn't map registers\n"); 593 1.1.2.2 martin return; 594 1.1.2.2 martin } 595 1.1.2.2 martin mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE); 596 1.1.2.2 martin mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_SCHED); 597 1.1.2.2 martin 598 1.1.2.2 martin sc->sc_conf = (void *)of_search_compatible(phandle, compat_data)->data; 599 1.1.2.2 martin sc->sc_grf = fdtbus_syscon_acquire(phandle, "rockchip,grf"); 600 1.1.2.2 martin if (sc->sc_grf != NULL && sc->sc_conf->oe_mask != 0) { 601 1.1.2.2 martin syscon_lock(sc->sc_grf); 602 1.1.2.2 martin val = __SHIFTIN(sc->sc_conf->oe_val, sc->sc_conf->oe_mask); 603 1.1.2.2 martin val |= (sc->sc_conf->oe_mask << 16); 604 1.1.2.2 martin syscon_write_4(sc->sc_grf, sc->sc_conf->oe_reg, val); 605 1.1.2.2 martin syscon_unlock(sc->sc_grf); 606 1.1.2.2 martin } 607 1.1.2.2 martin 608 1.1.2.2 martin if (rk_i2s_clock_init(sc) != 0) 609 1.1.2.2 martin return; 610 1.1.2.2 martin 611 1.1.2.2 martin aprint_naive("\n"); 612 1.1.2.2 martin aprint_normal(": I2S/PCM controller\n"); 613 1.1.2.2 martin 614 1.1.2.2 martin if (fdtbus_intr_establish(phandle, 0, IPL_AUDIO, FDT_INTR_MPSAFE, rk_i2s_intr, sc) == NULL) { 615 1.1.2.2 martin aprint_error_dev(self, "couldn't establish interrupt on %s\n", intrstr); 616 1.1.2.2 martin return; 617 1.1.2.2 martin } 618 1.1.2.2 martin aprint_normal_dev(self, "interrupting on %s\n", intrstr); 619 1.1.2.2 martin 620 1.1.2.2 martin sc->sc_format.mode = AUMODE_PLAY|AUMODE_RECORD; 621 1.1.2.2 martin sc->sc_format.encoding = AUDIO_ENCODING_SLINEAR_LE; 622 1.1.2.2 martin sc->sc_format.validbits = 16; 623 1.1.2.2 martin sc->sc_format.precision = 16; 624 1.1.2.2 martin sc->sc_format.channels = 2; 625 1.1.2.2 martin sc->sc_format.channel_mask = AUFMT_STEREO; 626 1.1.2.2 martin sc->sc_format.frequency_type = 1; 627 1.1.2.2 martin sc->sc_format.frequency[0] = RK_I2S_SAMPLE_RATE; 628 1.1.2.2 martin 629 1.1.2.2 martin sc->sc_dai.dai_set_sysclk = rk_i2s_dai_set_sysclk; 630 1.1.2.2 martin sc->sc_dai.dai_set_format = rk_i2s_dai_set_format; 631 1.1.2.2 martin sc->sc_dai.dai_hw_if = &rk_i2s_hw_if; 632 1.1.2.2 martin sc->sc_dai.dai_dev = self; 633 1.1.2.2 martin sc->sc_dai.dai_priv = sc; 634 1.1.2.2 martin fdtbus_register_dai_controller(self, phandle, &rk_i2s_dai_funcs); 635 1.1.2.2 martin } 636 1.1.2.2 martin 637 1.1.2.2 martin CFATTACH_DECL_NEW(rk_i2s, sizeof(struct rk_i2s_softc), 638 1.1.2.2 martin rk_i2s_match, rk_i2s_attach, NULL, NULL); 639
Indexes created Thu Oct 02 01:09:59 GMT 2025