ausoc.c revision 1.3.2.2
1 1.3.2.2 pgoyette /* $NetBSD: ausoc.c,v 1.3.2.2 2018/05/21 04:36:05 pgoyette Exp $ */ 2 1.3.2.2 pgoyette 3 1.3.2.2 pgoyette /*- 4 1.3.2.2 pgoyette * Copyright (c) 2018 Jared McNeill <jmcneill (at) invisible.ca> 5 1.3.2.2 pgoyette * All rights reserved. 6 1.3.2.2 pgoyette * 7 1.3.2.2 pgoyette * Redistribution and use in source and binary forms, with or without 8 1.3.2.2 pgoyette * modification, are permitted provided that the following conditions 9 1.3.2.2 pgoyette * are met: 10 1.3.2.2 pgoyette * 1. Redistributions of source code must retain the above copyright 11 1.3.2.2 pgoyette * notice, this list of conditions and the following disclaimer. 12 1.3.2.2 pgoyette * 2. Redistributions in binary form must reproduce the above copyright 13 1.3.2.2 pgoyette * notice, this list of conditions and the following disclaimer in the 14 1.3.2.2 pgoyette * documentation and/or other materials provided with the distribution. 15 1.3.2.2 pgoyette * 16 1.3.2.2 pgoyette * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 1.3.2.2 pgoyette * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18 1.3.2.2 pgoyette * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19 1.3.2.2 pgoyette * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 20 1.3.2.2 pgoyette * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 21 1.3.2.2 pgoyette * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 22 1.3.2.2 pgoyette * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 23 1.3.2.2 pgoyette * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 24 1.3.2.2 pgoyette * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 1.3.2.2 pgoyette * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 1.3.2.2 pgoyette * SUCH DAMAGE. 27 1.3.2.2 pgoyette */ 28 1.3.2.2 pgoyette 29 1.3.2.2 pgoyette #include <sys/cdefs.h> 30 1.3.2.2 pgoyette __KERNEL_RCSID(0, "$NetBSD: ausoc.c,v 1.3.2.2 2018/05/21 04:36:05 pgoyette Exp $"); 31 1.3.2.2 pgoyette 32 1.3.2.2 pgoyette #include <sys/param.h> 33 1.3.2.2 pgoyette #include <sys/bus.h> 34 1.3.2.2 pgoyette #include <sys/cpu.h> 35 1.3.2.2 pgoyette #include <sys/device.h> 36 1.3.2.2 pgoyette #include <sys/kmem.h> 37 1.3.2.2 pgoyette #include <sys/gpio.h> 38 1.3.2.2 pgoyette 39 1.3.2.2 pgoyette #include <sys/audioio.h> 40 1.3.2.2 pgoyette #include <dev/audio_if.h> 41 1.3.2.2 pgoyette #include <dev/audio_dai.h> 42 1.3.2.2 pgoyette 43 1.3.2.2 pgoyette #include <dev/fdt/fdtvar.h> 44 1.3.2.2 pgoyette 45 1.3.2.2 pgoyette static const char *compatible[] = { "simple-audio-card", NULL }; 46 1.3.2.2 pgoyette 47 1.3.2.2 pgoyette struct ausoc_link { 48 1.3.2.2 pgoyette const char *link_name; 49 1.3.2.2 pgoyette 50 1.3.2.2 pgoyette audio_dai_tag_t link_cpu; 51 1.3.2.2 pgoyette audio_dai_tag_t link_codec; 52 1.3.2.2 pgoyette audio_dai_tag_t *link_aux; 53 1.3.2.2 pgoyette u_int link_naux; 54 1.3.2.2 pgoyette 55 1.3.2.2 pgoyette u_int link_mclk_fs; 56 1.3.2.2 pgoyette 57 1.3.2.2 pgoyette kmutex_t link_lock; 58 1.3.2.2 pgoyette kmutex_t link_intr_lock; 59 1.3.2.2 pgoyette }; 60 1.3.2.2 pgoyette 61 1.3.2.2 pgoyette struct ausoc_softc { 62 1.3.2.2 pgoyette device_t sc_dev; 63 1.3.2.2 pgoyette int sc_phandle; 64 1.3.2.2 pgoyette const char *sc_name; 65 1.3.2.2 pgoyette 66 1.3.2.2 pgoyette struct ausoc_link *sc_link; 67 1.3.2.2 pgoyette u_int sc_nlink; 68 1.3.2.2 pgoyette }; 69 1.3.2.2 pgoyette 70 1.3.2.2 pgoyette static void 71 1.3.2.2 pgoyette ausoc_close(void *priv) 72 1.3.2.2 pgoyette { 73 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 74 1.3.2.2 pgoyette u_int aux; 75 1.3.2.2 pgoyette 76 1.3.2.2 pgoyette for (aux = 0; aux < link->link_naux; aux++) 77 1.3.2.2 pgoyette audio_dai_close(link->link_aux[aux]); 78 1.3.2.2 pgoyette audio_dai_close(link->link_codec); 79 1.3.2.2 pgoyette audio_dai_close(link->link_cpu); 80 1.3.2.2 pgoyette } 81 1.3.2.2 pgoyette 82 1.3.2.2 pgoyette static int 83 1.3.2.2 pgoyette ausoc_open(void *priv, int flags) 84 1.3.2.2 pgoyette { 85 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 86 1.3.2.2 pgoyette u_int aux; 87 1.3.2.2 pgoyette int error; 88 1.3.2.2 pgoyette 89 1.3.2.2 pgoyette error = audio_dai_open(link->link_cpu, flags); 90 1.3.2.2 pgoyette if (error) 91 1.3.2.2 pgoyette goto failed; 92 1.3.2.2 pgoyette 93 1.3.2.2 pgoyette error = audio_dai_open(link->link_codec, flags); 94 1.3.2.2 pgoyette if (error) 95 1.3.2.2 pgoyette goto failed; 96 1.3.2.2 pgoyette 97 1.3.2.2 pgoyette for (aux = 0; aux < link->link_naux; aux++) { 98 1.3.2.2 pgoyette error = audio_dai_open(link->link_aux[aux], flags); 99 1.3.2.2 pgoyette if (error) 100 1.3.2.2 pgoyette goto failed; 101 1.3.2.2 pgoyette } 102 1.3.2.2 pgoyette 103 1.3.2.2 pgoyette return 0; 104 1.3.2.2 pgoyette 105 1.3.2.2 pgoyette failed: 106 1.3.2.2 pgoyette ausoc_close(priv); 107 1.3.2.2 pgoyette return error; 108 1.3.2.2 pgoyette } 109 1.3.2.2 pgoyette 110 1.3.2.2 pgoyette static int 111 1.3.2.2 pgoyette ausoc_drain(void *priv) 112 1.3.2.2 pgoyette { 113 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 114 1.3.2.2 pgoyette 115 1.3.2.2 pgoyette return audio_dai_drain(link->link_cpu); 116 1.3.2.2 pgoyette } 117 1.3.2.2 pgoyette 118 1.3.2.2 pgoyette static int 119 1.3.2.2 pgoyette ausoc_query_encoding(void *priv, struct audio_encoding *ae) 120 1.3.2.2 pgoyette { 121 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 122 1.3.2.2 pgoyette 123 1.3.2.2 pgoyette return audio_dai_query_encoding(link->link_cpu, ae); 124 1.3.2.2 pgoyette } 125 1.3.2.2 pgoyette 126 1.3.2.2 pgoyette static int 127 1.3.2.2 pgoyette ausoc_set_params(void *priv, int setmode, int usemode, 128 1.3.2.2 pgoyette audio_params_t *play, audio_params_t *rec, 129 1.3.2.2 pgoyette stream_filter_list_t *pfil, stream_filter_list_t *rfil) 130 1.3.2.2 pgoyette { 131 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 132 1.3.2.2 pgoyette int error; 133 1.3.2.2 pgoyette 134 1.3.2.2 pgoyette error = audio_dai_set_params(link->link_cpu, setmode, 135 1.3.2.2 pgoyette usemode, play, rec, pfil, rfil); 136 1.3.2.2 pgoyette if (error) 137 1.3.2.2 pgoyette return error; 138 1.3.2.2 pgoyette 139 1.3.2.2 pgoyette return audio_dai_set_params(link->link_codec, setmode, 140 1.3.2.2 pgoyette usemode, play, rec, pfil, rfil); 141 1.3.2.2 pgoyette } 142 1.3.2.2 pgoyette 143 1.3.2.2 pgoyette static int 144 1.3.2.2 pgoyette ausoc_set_port(void *priv, mixer_ctrl_t *mc) 145 1.3.2.2 pgoyette { 146 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 147 1.3.2.2 pgoyette 148 1.3.2.2 pgoyette return audio_dai_set_port(link->link_codec, mc); 149 1.3.2.2 pgoyette } 150 1.3.2.2 pgoyette 151 1.3.2.2 pgoyette static int 152 1.3.2.2 pgoyette ausoc_get_port(void *priv, mixer_ctrl_t *mc) 153 1.3.2.2 pgoyette { 154 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 155 1.3.2.2 pgoyette 156 1.3.2.2 pgoyette return audio_dai_get_port(link->link_codec, mc); 157 1.3.2.2 pgoyette } 158 1.3.2.2 pgoyette 159 1.3.2.2 pgoyette static int 160 1.3.2.2 pgoyette ausoc_query_devinfo(void *priv, mixer_devinfo_t *di) 161 1.3.2.2 pgoyette { 162 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 163 1.3.2.2 pgoyette 164 1.3.2.2 pgoyette return audio_dai_query_devinfo(link->link_codec, di); 165 1.3.2.2 pgoyette } 166 1.3.2.2 pgoyette 167 1.3.2.2 pgoyette static void * 168 1.3.2.2 pgoyette ausoc_allocm(void *priv, int dir, size_t size) 169 1.3.2.2 pgoyette { 170 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 171 1.3.2.2 pgoyette 172 1.3.2.2 pgoyette return audio_dai_allocm(link->link_cpu, dir, size); 173 1.3.2.2 pgoyette } 174 1.3.2.2 pgoyette 175 1.3.2.2 pgoyette static void 176 1.3.2.2 pgoyette ausoc_freem(void *priv, void *addr, size_t size) 177 1.3.2.2 pgoyette { 178 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 179 1.3.2.2 pgoyette 180 1.3.2.2 pgoyette return audio_dai_freem(link->link_cpu, addr, size); 181 1.3.2.2 pgoyette } 182 1.3.2.2 pgoyette 183 1.3.2.2 pgoyette static paddr_t 184 1.3.2.2 pgoyette ausoc_mappage(void *priv, void *addr, off_t off, int prot) 185 1.3.2.2 pgoyette { 186 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 187 1.3.2.2 pgoyette 188 1.3.2.2 pgoyette return audio_dai_mappage(link->link_cpu, addr, off, prot); 189 1.3.2.2 pgoyette } 190 1.3.2.2 pgoyette 191 1.3.2.2 pgoyette static int 192 1.3.2.2 pgoyette ausoc_getdev(void *priv, struct audio_device *adev) 193 1.3.2.2 pgoyette { 194 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 195 1.3.2.2 pgoyette 196 1.3.2.2 pgoyette /* Defaults */ 197 1.3.2.2 pgoyette snprintf(adev->name, sizeof(adev->name), "%s", link->link_name); 198 1.3.2.2 pgoyette snprintf(adev->version, sizeof(adev->version), ""); 199 1.3.2.2 pgoyette snprintf(adev->config, sizeof(adev->config), "ausoc"); 200 1.3.2.2 pgoyette 201 1.3.2.2 pgoyette /* Codec can override */ 202 1.3.2.2 pgoyette (void)audio_dai_getdev(link->link_codec, adev); 203 1.3.2.2 pgoyette 204 1.3.2.2 pgoyette return 0; 205 1.3.2.2 pgoyette } 206 1.3.2.2 pgoyette 207 1.3.2.2 pgoyette static int 208 1.3.2.2 pgoyette ausoc_get_props(void *priv) 209 1.3.2.2 pgoyette { 210 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 211 1.3.2.2 pgoyette 212 1.3.2.2 pgoyette return audio_dai_get_props(link->link_cpu); 213 1.3.2.2 pgoyette } 214 1.3.2.2 pgoyette 215 1.3.2.2 pgoyette static int 216 1.3.2.2 pgoyette ausoc_round_blocksize(void *priv, int bs, int mode, 217 1.3.2.2 pgoyette const audio_params_t *params) 218 1.3.2.2 pgoyette { 219 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 220 1.3.2.2 pgoyette 221 1.3.2.2 pgoyette return audio_dai_round_blocksize(link->link_cpu, bs, mode, params); 222 1.3.2.2 pgoyette } 223 1.3.2.2 pgoyette 224 1.3.2.2 pgoyette static size_t 225 1.3.2.2 pgoyette ausoc_round_buffersize(void *priv, int dir, size_t bufsize) 226 1.3.2.2 pgoyette { 227 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 228 1.3.2.2 pgoyette 229 1.3.2.2 pgoyette return audio_dai_round_buffersize(link->link_cpu, dir, bufsize); 230 1.3.2.2 pgoyette } 231 1.3.2.2 pgoyette 232 1.3.2.2 pgoyette static int 233 1.3.2.2 pgoyette ausoc_halt_output(void *priv) 234 1.3.2.2 pgoyette { 235 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 236 1.3.2.2 pgoyette u_int n; 237 1.3.2.2 pgoyette 238 1.3.2.2 pgoyette for (n = 0; n < link->link_naux; n++) 239 1.3.2.2 pgoyette audio_dai_halt(link->link_aux[n], AUMODE_PLAY); 240 1.3.2.2 pgoyette 241 1.3.2.2 pgoyette audio_dai_halt(link->link_codec, AUMODE_PLAY); 242 1.3.2.2 pgoyette 243 1.3.2.2 pgoyette return audio_dai_halt(link->link_cpu, AUMODE_PLAY); 244 1.3.2.2 pgoyette } 245 1.3.2.2 pgoyette 246 1.3.2.2 pgoyette static int 247 1.3.2.2 pgoyette ausoc_halt_input(void *priv) 248 1.3.2.2 pgoyette { 249 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 250 1.3.2.2 pgoyette u_int n; 251 1.3.2.2 pgoyette 252 1.3.2.2 pgoyette for (n = 0; n < link->link_naux; n++) 253 1.3.2.2 pgoyette audio_dai_halt(link->link_aux[n], AUMODE_RECORD); 254 1.3.2.2 pgoyette 255 1.3.2.2 pgoyette audio_dai_halt(link->link_codec, AUMODE_RECORD); 256 1.3.2.2 pgoyette 257 1.3.2.2 pgoyette return audio_dai_halt(link->link_cpu, AUMODE_RECORD); 258 1.3.2.2 pgoyette } 259 1.3.2.2 pgoyette 260 1.3.2.2 pgoyette static int 261 1.3.2.2 pgoyette ausoc_trigger_output(void *priv, void *start, void *end, int blksize, 262 1.3.2.2 pgoyette void (*intr)(void *), void *intrarg, const audio_params_t *params) 263 1.3.2.2 pgoyette { 264 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 265 1.3.2.2 pgoyette u_int n, rate; 266 1.3.2.2 pgoyette int error; 267 1.3.2.2 pgoyette 268 1.3.2.2 pgoyette if (link->link_mclk_fs) { 269 1.3.2.2 pgoyette rate = params->sample_rate * link->link_mclk_fs; 270 1.3.2.2 pgoyette error = audio_dai_set_sysclk(link->link_codec, rate, 271 1.3.2.2 pgoyette AUDIO_DAI_CLOCK_IN); 272 1.3.2.2 pgoyette if (error) 273 1.3.2.2 pgoyette goto failed; 274 1.3.2.2 pgoyette error = audio_dai_set_sysclk(link->link_cpu, rate, 275 1.3.2.2 pgoyette AUDIO_DAI_CLOCK_OUT); 276 1.3.2.2 pgoyette if (error) 277 1.3.2.2 pgoyette goto failed; 278 1.3.2.2 pgoyette } 279 1.3.2.2 pgoyette 280 1.3.2.2 pgoyette for (n = 0; n < link->link_naux; n++) { 281 1.3.2.2 pgoyette error = audio_dai_trigger(link->link_aux[n], start, end, 282 1.3.2.2 pgoyette blksize, intr, intrarg, params, AUMODE_PLAY); 283 1.3.2.2 pgoyette if (error) 284 1.3.2.2 pgoyette goto failed; 285 1.3.2.2 pgoyette } 286 1.3.2.2 pgoyette error = audio_dai_trigger(link->link_codec, start, end, blksize, 287 1.3.2.2 pgoyette intr, intrarg, params, AUMODE_PLAY); 288 1.3.2.2 pgoyette if (error) 289 1.3.2.2 pgoyette goto failed; 290 1.3.2.2 pgoyette 291 1.3.2.2 pgoyette return audio_dai_trigger(link->link_cpu, start, end, blksize, 292 1.3.2.2 pgoyette intr, intrarg, params, AUMODE_PLAY); 293 1.3.2.2 pgoyette 294 1.3.2.2 pgoyette failed: 295 1.3.2.2 pgoyette ausoc_halt_output(priv); 296 1.3.2.2 pgoyette return error; 297 1.3.2.2 pgoyette } 298 1.3.2.2 pgoyette 299 1.3.2.2 pgoyette static int 300 1.3.2.2 pgoyette ausoc_trigger_input(void *priv, void *start, void *end, int blksize, 301 1.3.2.2 pgoyette void (*intr)(void *), void *intrarg, const audio_params_t *params) 302 1.3.2.2 pgoyette { 303 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 304 1.3.2.2 pgoyette u_int n, rate; 305 1.3.2.2 pgoyette int error; 306 1.3.2.2 pgoyette 307 1.3.2.2 pgoyette if (link->link_mclk_fs) { 308 1.3.2.2 pgoyette rate = params->sample_rate * link->link_mclk_fs; 309 1.3.2.2 pgoyette error = audio_dai_set_sysclk(link->link_codec, rate, 310 1.3.2.2 pgoyette AUDIO_DAI_CLOCK_IN); 311 1.3.2.2 pgoyette if (error) 312 1.3.2.2 pgoyette goto failed; 313 1.3.2.2 pgoyette error = audio_dai_set_sysclk(link->link_cpu, rate, 314 1.3.2.2 pgoyette AUDIO_DAI_CLOCK_OUT); 315 1.3.2.2 pgoyette if (error) 316 1.3.2.2 pgoyette goto failed; 317 1.3.2.2 pgoyette } 318 1.3.2.2 pgoyette 319 1.3.2.2 pgoyette for (n = 0; n < link->link_naux; n++) { 320 1.3.2.2 pgoyette error = audio_dai_trigger(link->link_aux[n], start, end, 321 1.3.2.2 pgoyette blksize, intr, intrarg, params, AUMODE_RECORD); 322 1.3.2.2 pgoyette if (error) 323 1.3.2.2 pgoyette goto failed; 324 1.3.2.2 pgoyette } 325 1.3.2.2 pgoyette error = audio_dai_trigger(link->link_codec, start, end, blksize, 326 1.3.2.2 pgoyette intr, intrarg, params, AUMODE_RECORD); 327 1.3.2.2 pgoyette if (error) 328 1.3.2.2 pgoyette goto failed; 329 1.3.2.2 pgoyette 330 1.3.2.2 pgoyette return audio_dai_trigger(link->link_cpu, start, end, blksize, 331 1.3.2.2 pgoyette intr, intrarg, params, AUMODE_RECORD); 332 1.3.2.2 pgoyette 333 1.3.2.2 pgoyette failed: 334 1.3.2.2 pgoyette ausoc_halt_input(priv); 335 1.3.2.2 pgoyette return error; 336 1.3.2.2 pgoyette } 337 1.3.2.2 pgoyette 338 1.3.2.2 pgoyette static void 339 1.3.2.2 pgoyette ausoc_get_locks(void *priv, kmutex_t **intr, kmutex_t **thread) 340 1.3.2.2 pgoyette { 341 1.3.2.2 pgoyette struct ausoc_link * const link = priv; 342 1.3.2.2 pgoyette 343 1.3.2.2 pgoyette return audio_dai_get_locks(link->link_cpu, intr, thread); 344 1.3.2.2 pgoyette } 345 1.3.2.2 pgoyette 346 1.3.2.2 pgoyette static const struct audio_hw_if ausoc_hw_if = { 347 1.3.2.2 pgoyette .open = ausoc_open, 348 1.3.2.2 pgoyette .close = ausoc_close, 349 1.3.2.2 pgoyette .drain = ausoc_drain, 350 1.3.2.2 pgoyette .query_encoding = ausoc_query_encoding, 351 1.3.2.2 pgoyette .set_params = ausoc_set_params, 352 1.3.2.2 pgoyette .allocm = ausoc_allocm, 353 1.3.2.2 pgoyette .freem = ausoc_freem, 354 1.3.2.2 pgoyette .mappage = ausoc_mappage, 355 1.3.2.2 pgoyette .getdev = ausoc_getdev, 356 1.3.2.2 pgoyette .set_port = ausoc_set_port, 357 1.3.2.2 pgoyette .get_port = ausoc_get_port, 358 1.3.2.2 pgoyette .query_devinfo = ausoc_query_devinfo, 359 1.3.2.2 pgoyette .get_props = ausoc_get_props, 360 1.3.2.2 pgoyette .round_blocksize = ausoc_round_blocksize, 361 1.3.2.2 pgoyette .round_buffersize = ausoc_round_buffersize, 362 1.3.2.2 pgoyette .trigger_output = ausoc_trigger_output, 363 1.3.2.2 pgoyette .trigger_input = ausoc_trigger_input, 364 1.3.2.2 pgoyette .halt_output = ausoc_halt_output, 365 1.3.2.2 pgoyette .halt_input = ausoc_halt_input, 366 1.3.2.2 pgoyette .get_locks = ausoc_get_locks, 367 1.3.2.2 pgoyette }; 368 1.3.2.2 pgoyette 369 1.3.2.2 pgoyette static int 370 1.3.2.2 pgoyette ausoc_match(device_t parent, cfdata_t cf, void *aux) 371 1.3.2.2 pgoyette { 372 1.3.2.2 pgoyette struct fdt_attach_args * const faa = aux; 373 1.3.2.2 pgoyette 374 1.3.2.2 pgoyette return of_match_compatible(faa->faa_phandle, compatible); 375 1.3.2.2 pgoyette } 376 1.3.2.2 pgoyette 377 1.3.2.2 pgoyette static struct { 378 1.3.2.2 pgoyette const char *name; 379 1.3.2.2 pgoyette u_int fmt; 380 1.3.2.2 pgoyette } ausoc_dai_formats[] = { 381 1.3.2.2 pgoyette { "i2s", AUDIO_DAI_FORMAT_I2S }, 382 1.3.2.2 pgoyette { "right_j", AUDIO_DAI_FORMAT_RJ }, 383 1.3.2.2 pgoyette { "left_j", AUDIO_DAI_FORMAT_LJ }, 384 1.3.2.2 pgoyette { "dsp_a", AUDIO_DAI_FORMAT_DSPA }, 385 1.3.2.2 pgoyette { "dsp_b", AUDIO_DAI_FORMAT_DSPB }, 386 1.3.2.2 pgoyette { "ac97", AUDIO_DAI_FORMAT_AC97 }, 387 1.3.2.2 pgoyette { "pdm", AUDIO_DAI_FORMAT_PDM }, 388 1.3.2.2 pgoyette }; 389 1.3.2.2 pgoyette 390 1.3.2.2 pgoyette static int 391 1.3.2.2 pgoyette ausoc_link_format(struct ausoc_softc *sc, struct ausoc_link *link, int phandle, 392 1.3.2.2 pgoyette int dai_phandle, bool single_link, u_int *format) 393 1.3.2.2 pgoyette { 394 1.3.2.2 pgoyette const char *format_prop = single_link ? 395 1.3.2.2 pgoyette "simple-audio-card,format" : "format"; 396 1.3.2.2 pgoyette const char *frame_master_prop = single_link ? 397 1.3.2.2 pgoyette "simple-audio-card,frame-master" : "frame-master"; 398 1.3.2.2 pgoyette const char *bitclock_master_prop = single_link ? 399 1.3.2.2 pgoyette "simple-audio-card,bitclock-master" : "bitclock-master"; 400 1.3.2.2 pgoyette const char *bitclock_inversion_prop = single_link ? 401 1.3.2.2 pgoyette "simple-audio-card,bitclock-inversion" : "bitclock-inversion"; 402 1.3.2.2 pgoyette const char *frame_inversion_prop = single_link ? 403 1.3.2.2 pgoyette "simple-audio-card,frame-inversion" : "frame-inversion"; 404 1.3.2.2 pgoyette 405 1.3.2.2 pgoyette u_int fmt, pol, clk; 406 1.3.2.2 pgoyette const char *s; 407 1.3.2.2 pgoyette u_int n; 408 1.3.2.2 pgoyette 409 1.3.2.2 pgoyette s = fdtbus_get_string(phandle, format_prop); 410 1.3.2.2 pgoyette if (s) { 411 1.3.2.2 pgoyette for (n = 0; n < __arraycount(ausoc_dai_formats); n++) { 412 1.3.2.2 pgoyette if (strcmp(s, ausoc_dai_formats[n].name) == 0) { 413 1.3.2.2 pgoyette fmt = ausoc_dai_formats[n].fmt; 414 1.3.2.2 pgoyette break; 415 1.3.2.2 pgoyette } 416 1.3.2.2 pgoyette } 417 1.3.2.2 pgoyette if (n == __arraycount(ausoc_dai_formats)) 418 1.3.2.2 pgoyette return EINVAL; 419 1.3.2.2 pgoyette } else { 420 1.3.2.2 pgoyette fmt = AUDIO_DAI_FORMAT_I2S; 421 1.3.2.2 pgoyette } 422 1.3.2.2 pgoyette 423 1.3.2.2 pgoyette const bool frame_master = 424 1.3.2.2 pgoyette dai_phandle == fdtbus_get_phandle(phandle, frame_master_prop); 425 1.3.2.2 pgoyette const bool bitclock_master = 426 1.3.2.2 pgoyette dai_phandle == fdtbus_get_phandle(phandle, bitclock_master_prop); 427 1.3.2.2 pgoyette if (frame_master) { 428 1.3.2.2 pgoyette clk = bitclock_master ? 429 1.3.2.2 pgoyette AUDIO_DAI_CLOCK_CBM_CFM : AUDIO_DAI_CLOCK_CBS_CFM; 430 1.3.2.2 pgoyette } else { 431 1.3.2.2 pgoyette clk = bitclock_master ? 432 1.3.2.2 pgoyette AUDIO_DAI_CLOCK_CBM_CFS : AUDIO_DAI_CLOCK_CBS_CFS; 433 1.3.2.2 pgoyette } 434 1.3.2.2 pgoyette 435 1.3.2.2 pgoyette const bool bitclock_inversion = of_hasprop(phandle, bitclock_inversion_prop); 436 1.3.2.2 pgoyette const bool frame_inversion = of_hasprop(phandle, frame_inversion_prop); 437 1.3.2.2 pgoyette if (bitclock_inversion) { 438 1.3.2.2 pgoyette pol = frame_inversion ? 439 1.3.2.2 pgoyette AUDIO_DAI_POLARITY_IB_IF : AUDIO_DAI_POLARITY_IB_NF; 440 1.3.2.2 pgoyette } else { 441 1.3.2.2 pgoyette pol = frame_inversion ? 442 1.3.2.2 pgoyette AUDIO_DAI_POLARITY_NB_IF : AUDIO_DAI_POLARITY_NB_NF; 443 1.3.2.2 pgoyette } 444 1.3.2.2 pgoyette 445 1.3.2.2 pgoyette *format = __SHIFTIN(fmt, AUDIO_DAI_FORMAT_MASK) | 446 1.3.2.2 pgoyette __SHIFTIN(pol, AUDIO_DAI_POLARITY_MASK) | 447 1.3.2.2 pgoyette __SHIFTIN(clk, AUDIO_DAI_CLOCK_MASK); 448 1.3.2.2 pgoyette 449 1.3.2.2 pgoyette return 0; 450 1.3.2.2 pgoyette } 451 1.3.2.2 pgoyette 452 1.3.2.2 pgoyette static void 453 1.3.2.2 pgoyette ausoc_attach_link(struct ausoc_softc *sc, struct ausoc_link *link, 454 1.3.2.2 pgoyette int card_phandle, int link_phandle) 455 1.3.2.2 pgoyette { 456 1.3.2.2 pgoyette const bool single_link = card_phandle == link_phandle; 457 1.3.2.2 pgoyette const char *cpu_prop = single_link ? 458 1.3.2.2 pgoyette "simple-audio-card,cpu" : "cpu"; 459 1.3.2.2 pgoyette const char *codec_prop = single_link ? 460 1.3.2.2 pgoyette "simple-audio-card,codec" : "codec"; 461 1.3.2.2 pgoyette const char *mclk_fs_prop = single_link ? 462 1.3.2.2 pgoyette "simple-audio-card,mclk-fs" : "mclk-fs"; 463 1.3.2.2 pgoyette const char *node_name = fdtbus_get_string(link_phandle, "name"); 464 1.3.2.2 pgoyette u_int n, format; 465 1.3.2.2 pgoyette 466 1.3.2.2 pgoyette const int cpu_phandle = of_find_firstchild_byname(link_phandle, cpu_prop); 467 1.3.2.2 pgoyette if (cpu_phandle <= 0) { 468 1.3.2.2 pgoyette aprint_error_dev(sc->sc_dev, "missing %s prop on %s node\n", 469 1.3.2.2 pgoyette cpu_prop, node_name); 470 1.3.2.2 pgoyette return; 471 1.3.2.2 pgoyette } 472 1.3.2.2 pgoyette 473 1.3.2.2 pgoyette link->link_cpu = fdtbus_dai_acquire(cpu_phandle, "sound-dai"); 474 1.3.2.2 pgoyette if (!link->link_cpu) { 475 1.3.2.2 pgoyette aprint_error_dev(sc->sc_dev, 476 1.3.2.2 pgoyette "couldn't acquire cpu dai on %s node\n", node_name); 477 1.3.2.2 pgoyette return; 478 1.3.2.2 pgoyette } 479 1.3.2.2 pgoyette 480 1.3.2.2 pgoyette const int codec_phandle = of_find_firstchild_byname(link_phandle, codec_prop); 481 1.3.2.2 pgoyette if (codec_phandle <= 0) { 482 1.3.2.2 pgoyette aprint_error_dev(sc->sc_dev, "missing %s prop on %s node\n", 483 1.3.2.2 pgoyette codec_prop, node_name); 484 1.3.2.2 pgoyette return; 485 1.3.2.2 pgoyette } 486 1.3.2.2 pgoyette 487 1.3.2.2 pgoyette link->link_codec = fdtbus_dai_acquire(codec_phandle, "sound-dai"); 488 1.3.2.2 pgoyette if (!link->link_codec) { 489 1.3.2.2 pgoyette aprint_error_dev(sc->sc_dev, 490 1.3.2.2 pgoyette "couldn't acquire codec dai on %s node\n", node_name); 491 1.3.2.2 pgoyette return; 492 1.3.2.2 pgoyette } 493 1.3.2.2 pgoyette 494 1.3.2.2 pgoyette for (;;) { 495 1.3.2.2 pgoyette if (fdtbus_dai_acquire_index(card_phandle, 496 1.3.2.2 pgoyette "simple-audio-card,aux-devs", link->link_naux) == NULL) 497 1.3.2.2 pgoyette break; 498 1.3.2.2 pgoyette link->link_naux++; 499 1.3.2.2 pgoyette } 500 1.3.2.2 pgoyette if (link->link_naux) { 501 1.3.2.2 pgoyette link->link_aux = kmem_zalloc(sizeof(audio_dai_tag_t) * link->link_naux, KM_SLEEP); 502 1.3.2.2 pgoyette for (n = 0; n < link->link_naux; n++) { 503 1.3.2.2 pgoyette link->link_aux[n] = fdtbus_dai_acquire_index(card_phandle, 504 1.3.2.2 pgoyette "simple-audio-card,aux-devs", n); 505 1.3.2.2 pgoyette KASSERT(link->link_aux[n] != NULL); 506 1.3.2.2 pgoyette 507 1.3.2.2 pgoyette /* Attach aux devices to codec */ 508 1.3.2.2 pgoyette audio_dai_add_device(link->link_codec, link->link_aux[n]); 509 1.3.2.2 pgoyette } 510 1.3.2.2 pgoyette } 511 1.3.2.2 pgoyette 512 1.3.2.2 pgoyette of_getprop_uint32(link_phandle, mclk_fs_prop, &link->link_mclk_fs); 513 1.3.2.2 pgoyette if (ausoc_link_format(sc, link, link_phandle, codec_phandle, single_link, &format) != 0) { 514 1.3.2.2 pgoyette aprint_error_dev(sc->sc_dev, "couldn't parse format properties\n"); 515 1.3.2.2 pgoyette return; 516 1.3.2.2 pgoyette } 517 1.3.2.2 pgoyette if (audio_dai_set_format(link->link_cpu, format) != 0) { 518 1.3.2.2 pgoyette aprint_error_dev(sc->sc_dev, "couldn't set cpu format\n"); 519 1.3.2.2 pgoyette return; 520 1.3.2.2 pgoyette } 521 1.3.2.2 pgoyette if (audio_dai_set_format(link->link_codec, format) != 0) { 522 1.3.2.2 pgoyette aprint_error_dev(sc->sc_dev, "couldn't set codec format\n"); 523 1.3.2.2 pgoyette return; 524 1.3.2.2 pgoyette } 525 1.3.2.2 pgoyette 526 1.3.2.2 pgoyette aprint_normal_dev(sc->sc_dev, "codec: %s, cpu: %s", 527 1.3.2.2 pgoyette device_xname(audio_dai_device(link->link_codec)), 528 1.3.2.2 pgoyette device_xname(audio_dai_device(link->link_cpu))); 529 1.3.2.2 pgoyette for (n = 0; n < link->link_naux; n++) { 530 1.3.2.2 pgoyette if (n == 0) 531 1.3.2.2 pgoyette aprint_normal(", aux:"); 532 1.3.2.2 pgoyette aprint_normal(" %s", 533 1.3.2.2 pgoyette device_xname(audio_dai_device(link->link_aux[n]))); 534 1.3.2.2 pgoyette } 535 1.3.2.2 pgoyette aprint_normal("\n"); 536 1.3.2.2 pgoyette 537 1.3.2.2 pgoyette audio_attach_mi(&ausoc_hw_if, link, sc->sc_dev); 538 1.3.2.2 pgoyette } 539 1.3.2.2 pgoyette 540 1.3.2.2 pgoyette static void 541 1.3.2.2 pgoyette ausoc_attach_cb(device_t self) 542 1.3.2.2 pgoyette { 543 1.3.2.2 pgoyette struct ausoc_softc * const sc = device_private(self); 544 1.3.2.2 pgoyette const int phandle = sc->sc_phandle; 545 1.3.2.2 pgoyette const char *name; 546 1.3.2.2 pgoyette int child, n; 547 1.3.2.2 pgoyette size_t len; 548 1.3.2.2 pgoyette 549 1.3.2.2 pgoyette /* 550 1.3.2.2 pgoyette * If the root node defines a cpu and codec, there is only one link. For 551 1.3.2.2 pgoyette * cards with multiple links, there will be simple-audio-card,dai-link 552 1.3.2.2 pgoyette * child nodes for each one. 553 1.3.2.2 pgoyette */ 554 1.3.2.2 pgoyette if (of_find_firstchild_byname(phandle, "simple-audio-card,cpu") > 0 && 555 1.3.2.2 pgoyette of_find_firstchild_byname(phandle, "simple-audio-card,codec") > 0) { 556 1.3.2.2 pgoyette sc->sc_nlink = 1; 557 1.3.2.2 pgoyette sc->sc_link = kmem_zalloc(sizeof(*sc->sc_link), KM_SLEEP); 558 1.3.2.2 pgoyette sc->sc_link[0].link_name = sc->sc_name; 559 1.3.2.2 pgoyette ausoc_attach_link(sc, &sc->sc_link[0], phandle, phandle); 560 1.3.2.2 pgoyette } else { 561 1.3.2.2 pgoyette for (child = OF_child(phandle); child; child = OF_peer(child)) { 562 1.3.2.2 pgoyette name = fdtbus_get_string(child, "name"); 563 1.3.2.2 pgoyette len = strlen("simple-audio-card,dai-link"); 564 1.3.2.2 pgoyette if (strncmp(name, "simple-audio-card,dai-link", len) != 0) 565 1.3.2.2 pgoyette continue; 566 1.3.2.2 pgoyette sc->sc_nlink++; 567 1.3.2.2 pgoyette } 568 1.3.2.2 pgoyette if (sc->sc_nlink == 0) 569 1.3.2.2 pgoyette return; 570 1.3.2.2 pgoyette sc->sc_link = kmem_zalloc(sizeof(*sc->sc_link) * sc->sc_nlink, 571 1.3.2.2 pgoyette KM_SLEEP); 572 1.3.2.2 pgoyette for (child = OF_child(phandle), n = 0; child; child = OF_peer(child)) { 573 1.3.2.2 pgoyette name = fdtbus_get_string(child, "name"); 574 1.3.2.2 pgoyette len = strlen("simple-audio-card,dai-link"); 575 1.3.2.2 pgoyette if (strncmp(name, "simple-audio-card,dai-link", len) != 0) 576 1.3.2.2 pgoyette continue; 577 1.3.2.2 pgoyette sc->sc_link[n].link_name = sc->sc_name; 578 1.3.2.2 pgoyette ausoc_attach_link(sc, &sc->sc_link[n], phandle, child); 579 1.3.2.2 pgoyette n++; 580 1.3.2.2 pgoyette } 581 1.3.2.2 pgoyette } 582 1.3.2.2 pgoyette } 583 1.3.2.2 pgoyette 584 1.3.2.2 pgoyette static void 585 1.3.2.2 pgoyette ausoc_attach(device_t parent, device_t self, void *aux) 586 1.3.2.2 pgoyette { 587 1.3.2.2 pgoyette struct ausoc_softc * const sc = device_private(self); 588 1.3.2.2 pgoyette struct fdt_attach_args * const faa = aux; 589 1.3.2.2 pgoyette const int phandle = faa->faa_phandle; 590 1.3.2.2 pgoyette 591 1.3.2.2 pgoyette sc->sc_dev = self; 592 1.3.2.2 pgoyette sc->sc_phandle = phandle; 593 1.3.2.2 pgoyette sc->sc_name = fdtbus_get_string(phandle, "simple-audio-card,name"); 594 1.3.2.2 pgoyette if (!sc->sc_name) 595 1.3.2.2 pgoyette sc->sc_name = "SoC Audio"; 596 1.3.2.2 pgoyette 597 1.3.2.2 pgoyette aprint_naive("\n"); 598 1.3.2.2 pgoyette aprint_normal(": %s\n", sc->sc_name); 599 1.3.2.2 pgoyette 600 1.3.2.2 pgoyette /* 601 1.3.2.2 pgoyette * Defer attachment until all other drivers are ready. 602 1.3.2.2 pgoyette */ 603 1.3.2.2 pgoyette config_defer(self, ausoc_attach_cb); 604 1.3.2.2 pgoyette } 605 1.3.2.2 pgoyette 606 1.3.2.2 pgoyette CFATTACH_DECL_NEW(ausoc, sizeof(struct ausoc_softc), 607 1.3.2.2 pgoyette ausoc_match, ausoc_attach, NULL, NULL); 608
Indexes created Fri Oct 03 17:10:05 GMT 2025