snapper.c revision 1.43
1 /* $NetBSD: snapper.c,v 1.43 2018/01/29 19:33:39 macallan Exp $ */ 2 /* Id: snapper.c,v 1.11 2002/10/31 17:42:13 tsubai Exp */ 3 /* Id: i2s.c,v 1.12 2005/01/15 14:32:35 tsubai Exp */ 4 5 /*- 6 * Copyright (c) 2002, 2003 Tsubai Masanari. All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 3. The name of the author may not be used to endorse or promote products 17 * derived from this software without specific prior written permission. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 20 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 21 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 22 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 23 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 24 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 25 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 26 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 27 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 28 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 29 */ 30 31 /* 32 * Datasheet is available from 33 * http://www.ti.com/sc/docs/products/analog/tas3004.html 34 * http://www.ti.com/sc/docs/products/analog/tas3001.html 35 */ 36 37 #include <sys/cdefs.h> 38 __KERNEL_RCSID(0, "$NetBSD: snapper.c,v 1.43 2018/01/29 19:33:39 macallan Exp $"); 39 40 #include <sys/param.h> 41 #include <sys/audioio.h> 42 #include <sys/device.h> 43 #include <sys/systm.h> 44 #include <sys/malloc.h> 45 46 #include <dev/auconv.h> 47 #include <dev/audio_if.h> 48 #include <dev/mulaw.h> 49 #include <dev/ofw/openfirm.h> 50 #include <macppc/dev/dbdma.h> 51 52 #include <uvm/uvm_extern.h> 53 #include <dev/i2c/i2cvar.h> 54 55 #include <machine/autoconf.h> 56 #include <machine/pio.h> 57 58 #include <macppc/dev/deqvar.h> 59 #include <macppc/dev/obiovar.h> 60 61 #ifdef SNAPPER_DEBUG 62 # define DPRINTF printf 63 #else 64 # define DPRINTF while (0) printf 65 #endif 66 67 #define SNAPPER_MAXPAGES 16 68 69 struct snapper_softc { 70 device_t sc_dev; 71 int sc_mode; // 0 for TAS3004 72 #define SNAPPER_IS_TAS3001 1 // codec is TAS3001 73 #define SNAPPER_SWVOL 2 // software codec 74 75 int sc_node; 76 77 struct audio_encoding_set *sc_encodings; 78 79 void (*sc_ointr)(void *); /* dma completion intr handler */ 80 void *sc_oarg; /* arg for sc_ointr() */ 81 int sc_opages; /* # of output pages */ 82 83 void (*sc_iintr)(void *); /* dma completion intr handler */ 84 void *sc_iarg; /* arg for sc_iintr() */ 85 int sc_ipages; /* # of input pages */ 86 87 u_int sc_record_source; /* recording source mask */ 88 u_int sc_output_mask; /* output source mask */ 89 90 bus_space_tag_t sc_tag; 91 bus_space_handle_t sc_bsh; 92 i2c_addr_t sc_deqaddr; 93 i2c_tag_t sc_i2c; 94 uint32_t sc_baseaddr; 95 96 int sc_rate; /* current sampling rate */ 97 int sc_bitspersample; 98 99 int sc_swvol; 100 101 u_int sc_vol_l; 102 u_int sc_vol_r; 103 u_int sc_treble; 104 u_int sc_bass; 105 u_int mixer[6]; /* s1_l, s2_l, an_l, s1_r, s2_r, an_r */ 106 107 bus_space_handle_t sc_odmah; 108 bus_space_handle_t sc_idmah; 109 dbdma_regmap_t *sc_odma; 110 dbdma_regmap_t *sc_idma; 111 unsigned char dbdma_cmdspace[sizeof(struct dbdma_command) * 40 + 15]; 112 struct dbdma_command *sc_odmacmd; 113 struct dbdma_command *sc_idmacmd; 114 115 kmutex_t sc_lock; 116 kmutex_t sc_intr_lock; 117 }; 118 119 static int snapper_match(device_t, struct cfdata *, void *); 120 static void snapper_attach(device_t, device_t, void *); 121 static void snapper_defer(device_t); 122 static int snapper_intr(void *); 123 static int snapper_query_encoding(void *, struct audio_encoding *); 124 static int snapper_set_params(void *, int, int, audio_params_t *, 125 audio_params_t *, stream_filter_list_t *, stream_filter_list_t *); 126 static int snapper_round_blocksize(void *, int, int, const audio_params_t *); 127 static int snapper_halt_output(void *); 128 static int snapper_halt_input(void *); 129 static int snapper_getdev(void *, struct audio_device *); 130 static int snapper_set_port(void *, mixer_ctrl_t *); 131 static int snapper_get_port(void *, mixer_ctrl_t *); 132 static int snapper_query_devinfo(void *, mixer_devinfo_t *); 133 static size_t snapper_round_buffersize(void *, int, size_t); 134 static paddr_t snapper_mappage(void *, void *, off_t, int); 135 static int snapper_get_props(void *); 136 static int snapper_trigger_output(void *, void *, void *, int, void (*)(void *), 137 void *, const audio_params_t *); 138 static int snapper_trigger_input(void *, void *, void *, int, void (*)(void *), 139 void *, const audio_params_t *); 140 static void snapper_get_locks(void *, kmutex_t **, kmutex_t **); 141 static void snapper_set_volume(struct snapper_softc *, u_int, u_int); 142 static int snapper_set_rate(struct snapper_softc *); 143 static void snapper_set_treble(struct snapper_softc *, u_int); 144 static void snapper_set_bass(struct snapper_softc *, u_int); 145 static void snapper_write_mixers(struct snapper_softc *); 146 147 static int tas3004_write(struct snapper_softc *, u_int, const void *); 148 static int gpio_read(char *); 149 static void gpio_write(char *, int); 150 static void snapper_mute_speaker(struct snapper_softc *, int); 151 static void snapper_mute_headphone(struct snapper_softc *, int); 152 static int snapper_cint(void *); 153 static int tas3004_init(struct snapper_softc *); 154 static void snapper_init(struct snapper_softc *, int); 155 156 struct snapper_codecvar { 157 stream_filter_t base; 158 159 #ifdef DIAGNOSTIC 160 # define SNAPPER_CODECVAR_MAGIC 0xC0DEC 161 uint32_t magic; 162 #endif // DIAGNOSTIC 163 164 int16_t rval; // for snapper_fixphase 165 }; 166 167 static stream_filter_t *snapper_filter_factory 168 (int (*)(struct audio_softc *sc, stream_fetcher_t *, audio_stream_t *, int)); 169 static void snapper_filter_dtor(stream_filter_t *); 170 171 /* XXX We can't access the hw device softc from our audio 172 * filter -- lame... 173 */ 174 static u_int snapper_vol_l = 128, snapper_vol_r = 128; 175 176 /* XXX why doesn't auconv define this? */ 177 #define DEFINE_FILTER(name) \ 178 static int \ 179 name##_fetch_to(struct audio_softc *, stream_fetcher_t *, audio_stream_t *, int); \ 180 stream_filter_t * name(struct audio_softc *, \ 181 const audio_params_t *, const audio_params_t *); \ 182 stream_filter_t * \ 183 name(struct audio_softc *sc, const audio_params_t *from, \ 184 const audio_params_t *to) \ 185 { \ 186 return snapper_filter_factory(name##_fetch_to); \ 187 } \ 188 static int \ 189 name##_fetch_to(struct audio_softc *sc, stream_fetcher_t *self, audio_stream_t *dst, int max_used) 190 191 DEFINE_FILTER(snapper_volume) 192 { 193 stream_filter_t *this; 194 int16_t j; 195 int16_t *wp; 196 int m, err; 197 198 this = (stream_filter_t *)self; 199 max_used = (max_used + 1) & ~1; 200 if ((err = this->prev->fetch_to(sc, this->prev, this->src, max_used))) 201 return err; 202 m = (dst->end - dst->start) & ~1; 203 m = min(m, max_used); 204 FILTER_LOOP_PROLOGUE(this->src, 2, dst, 2, m) { 205 j = (s[0] << 8 | s[1]); 206 wp = (int16_t *)d; 207 *wp = ((j * snapper_vol_l) / 255); 208 } FILTER_LOOP_EPILOGUE(this->src, dst); 209 210 return 0; 211 } 212 213 /* 214 * A hardware bug in the TAS3004 I2S transport 215 * produces phase differences between channels 216 * (left channel appears delayed by one sample). 217 * Fix the phase difference by delaying the right channel 218 * by one sample. 219 */ 220 DEFINE_FILTER(snapper_fixphase) 221 { 222 struct snapper_codecvar *cv = (struct snapper_codecvar *) self; 223 stream_filter_t *this = &cv->base; 224 int err, m; 225 const int16_t *rp; 226 int16_t *wp, rval = cv->rval; 227 228 #ifdef DIAGNOSTIC 229 if (cv->magic != SNAPPER_CODECVAR_MAGIC) 230 panic("snapper_fixphase"); 231 #endif 232 max_used = (max_used + 3) & ~2; 233 if ((err = this->prev->fetch_to(sc, this->prev, this->src, max_used))) 234 return err; 235 236 /* work in stereo frames (4 bytes) */ 237 m = (dst->end - dst->start) & ~2; 238 m = min(m, max_used); 239 FILTER_LOOP_PROLOGUE(this->src, 4, dst, 4, m) { 240 rp = (const int16_t *) s; 241 wp = (int16_t *) d; 242 wp[0] = rp[0]; 243 wp[1] = rval; 244 rval = rp[1]; 245 } FILTER_LOOP_EPILOGUE(this->src, dst); 246 cv->rval = rval; 247 248 return 0; 249 } 250 251 static stream_filter_t * 252 snapper_filter_factory(int (*fetch_to)(struct audio_softc *sc, stream_fetcher_t *, audio_stream_t *, int)) 253 { 254 struct snapper_codecvar *this; 255 256 this = malloc(sizeof(*this), M_DEVBUF, M_WAITOK | M_ZERO); 257 this->base.base.fetch_to = fetch_to; 258 this->base.dtor = snapper_filter_dtor; 259 this->base.set_fetcher = stream_filter_set_fetcher; 260 this->base.set_inputbuffer = stream_filter_set_inputbuffer; 261 262 #ifdef DIAGNOSTIC 263 this->magic = SNAPPER_CODECVAR_MAGIC; 264 #endif 265 return (stream_filter_t *) this; 266 } 267 268 static void 269 snapper_filter_dtor(stream_filter_t *this) 270 { 271 if (this != NULL) 272 free(this, M_DEVBUF); 273 } 274 275 CFATTACH_DECL_NEW(snapper, sizeof(struct snapper_softc), snapper_match, 276 snapper_attach, NULL, NULL); 277 278 const struct audio_hw_if snapper_hw_if = { 279 NULL, 280 NULL, 281 NULL, 282 snapper_query_encoding, 283 snapper_set_params, 284 snapper_round_blocksize, 285 NULL, 286 NULL, 287 NULL, 288 NULL, 289 NULL, 290 snapper_halt_output, 291 snapper_halt_input, 292 NULL, 293 snapper_getdev, 294 NULL, 295 snapper_set_port, 296 snapper_get_port, 297 snapper_query_devinfo, 298 NULL, 299 NULL, 300 snapper_round_buffersize, 301 snapper_mappage, 302 snapper_get_props, 303 snapper_trigger_output, 304 snapper_trigger_input, 305 NULL, 306 snapper_get_locks, 307 }; 308 309 struct audio_device snapper_device = { 310 "SNAPPER", 311 "", 312 "snapper" 313 }; 314 315 #define SNAPPER_BASSTAB_0DB 18 316 const uint8_t snapper_basstab[] = { 317 0x96, /* -18dB */ 318 0x94, /* -17dB */ 319 0x92, /* -16dB */ 320 0x90, /* -15dB */ 321 0x8e, /* -14dB */ 322 0x8c, /* -13dB */ 323 0x8a, /* -12dB */ 324 0x88, /* -11dB */ 325 0x86, /* -10dB */ 326 0x84, /* -9dB */ 327 0x82, /* -8dB */ 328 0x80, /* -7dB */ 329 0x7e, /* -6dB */ 330 0x7c, /* -5dB */ 331 0x7a, /* -4dB */ 332 0x78, /* -3dB */ 333 0x76, /* -2dB */ 334 0x74, /* -1dB */ 335 0x72, /* 0dB */ 336 0x6f, /* 1dB */ 337 0x6d, /* 2dB */ 338 0x6a, /* 3dB */ 339 0x67, /* 4dB */ 340 0x65, /* 5dB */ 341 0x62, /* 6dB */ 342 0x5f, /* 7dB */ 343 0x5b, /* 8dB */ 344 0x55, /* 9dB */ 345 0x4f, /* 10dB */ 346 0x49, /* 11dB */ 347 0x43, /* 12dB */ 348 0x3b, /* 13dB */ 349 0x33, /* 14dB */ 350 0x29, /* 15dB */ 351 0x1e, /* 16dB */ 352 0x11, /* 17dB */ 353 0x01, /* 18dB */ 354 }; 355 356 #define SNAPPER_MIXER_GAIN_0DB 36 357 const uint8_t snapper_mixer_gain[178][3] = { 358 { 0x7f, 0x17, 0xaf }, /* 18.0 dB */ 359 { 0x77, 0xfb, 0xaa }, /* 17.5 dB */ 360 { 0x71, 0x45, 0x75 }, /* 17.0 dB */ 361 { 0x6a, 0xef, 0x5d }, /* 16.5 dB */ 362 { 0x64, 0xf4, 0x03 }, /* 16.0 dB */ 363 { 0x5f, 0x4e, 0x52 }, /* 15.5 dB */ 364 { 0x59, 0xf9, 0x80 }, /* 15.0 dB */ 365 { 0x54, 0xf1, 0x06 }, /* 14.5 dB */ 366 { 0x50, 0x30, 0xa1 }, /* 14.0 dB */ 367 { 0x4b, 0xb4, 0x46 }, /* 13.5 dB */ 368 { 0x47, 0x78, 0x28 }, /* 13.0 dB */ 369 { 0x43, 0x78, 0xb0 }, /* 12.5 dB */ 370 { 0x3f, 0xb2, 0x78 }, /* 12.0 dB */ 371 { 0x3c, 0x22, 0x4c }, /* 11.5 dB */ 372 { 0x38, 0xc5, 0x28 }, /* 11.0 dB */ 373 { 0x35, 0x98, 0x2f }, /* 10.5 dB */ 374 { 0x32, 0x98, 0xb0 }, /* 10.0 dB */ 375 { 0x2f, 0xc4, 0x20 }, /* 9.5 dB */ 376 { 0x2d, 0x18, 0x18 }, /* 9.0 dB */ 377 { 0x2a, 0x92, 0x54 }, /* 8.5 dB */ 378 { 0x28, 0x30, 0xaf }, /* 8.0 dB */ 379 { 0x25, 0xf1, 0x25 }, /* 7.5 dB */ 380 { 0x23, 0xd1, 0xcd }, /* 7.0 dB */ 381 { 0x21, 0xd0, 0xd9 }, /* 6.5 dB */ 382 { 0x1f, 0xec, 0x98 }, /* 6.0 dB */ 383 { 0x1e, 0x23, 0x6d }, /* 5.5 dB */ 384 { 0x1c, 0x73, 0xd5 }, /* 5.0 dB */ 385 { 0x1a, 0xdc, 0x61 }, /* 4.5 dB */ 386 { 0x19, 0x5b, 0xb8 }, /* 4.0 dB */ 387 { 0x17, 0xf0, 0x94 }, /* 3.5 dB */ 388 { 0x16, 0x99, 0xc0 }, /* 3.0 dB */ 389 { 0x15, 0x56, 0x1a }, /* 2.5 dB */ 390 { 0x14, 0x24, 0x8e }, /* 2.0 dB */ 391 { 0x13, 0x04, 0x1a }, /* 1.5 dB */ 392 { 0x11, 0xf3, 0xc9 }, /* 1.0 dB */ 393 { 0x10, 0xf2, 0xb4 }, /* 0.5 dB */ 394 { 0x10, 0x00, 0x00 }, /* 0.0 dB */ 395 { 0x0f, 0x1a, 0xdf }, /* -0.5 dB */ 396 { 0x0e, 0x42, 0x90 }, /* -1.0 dB */ 397 { 0x0d, 0x76, 0x5a }, /* -1.5 dB */ 398 { 0x0c, 0xb5, 0x91 }, /* -2.0 dB */ 399 { 0x0b, 0xff, 0x91 }, /* -2.5 dB */ 400 { 0x0b, 0x53, 0xbe }, /* -3.0 dB */ 401 { 0x0a, 0xb1, 0x89 }, /* -3.5 dB */ 402 { 0x0a, 0x18, 0x66 }, /* -4.0 dB */ 403 { 0x09, 0x87, 0xd5 }, /* -4.5 dB */ 404 { 0x08, 0xff, 0x59 }, /* -5.0 dB */ 405 { 0x08, 0x7e, 0x80 }, /* -5.5 dB */ 406 { 0x08, 0x04, 0xdc }, /* -6.0 dB */ 407 { 0x07, 0x92, 0x07 }, /* -6.5 dB */ 408 { 0x07, 0x25, 0x9d }, /* -7.0 dB */ 409 { 0x06, 0xbf, 0x44 }, /* -7.5 dB */ 410 { 0x06, 0x5e, 0xa5 }, /* -8.0 dB */ 411 { 0x06, 0x03, 0x6e }, /* -8.5 dB */ 412 { 0x05, 0xad, 0x50 }, /* -9.0 dB */ 413 { 0x05, 0x5c, 0x04 }, /* -9.5 dB */ 414 { 0x05, 0x0f, 0x44 }, /* -10.0 dB */ 415 { 0x04, 0xc6, 0xd0 }, /* -10.5 dB */ 416 { 0x04, 0x82, 0x68 }, /* -11.0 dB */ 417 { 0x04, 0x41, 0xd5 }, /* -11.5 dB */ 418 { 0x04, 0x04, 0xde }, /* -12.0 dB */ 419 { 0x03, 0xcb, 0x50 }, /* -12.5 dB */ 420 { 0x03, 0x94, 0xfa }, /* -13.0 dB */ 421 { 0x03, 0x61, 0xaf }, /* -13.5 dB */ 422 { 0x03, 0x31, 0x42 }, /* -14.0 dB */ 423 { 0x03, 0x03, 0x8a }, /* -14.5 dB */ 424 { 0x02, 0xd8, 0x62 }, /* -15.0 dB */ 425 { 0x02, 0xaf, 0xa3 }, /* -15.5 dB */ 426 { 0x02, 0x89, 0x2c }, /* -16.0 dB */ 427 { 0x02, 0x64, 0xdb }, /* -16.5 dB */ 428 { 0x02, 0x42, 0x93 }, /* -17.0 dB */ 429 { 0x02, 0x22, 0x35 }, /* -17.5 dB */ 430 { 0x02, 0x03, 0xa7 }, /* -18.0 dB */ 431 { 0x01, 0xe6, 0xcf }, /* -18.5 dB */ 432 { 0x01, 0xcb, 0x94 }, /* -19.0 dB */ 433 { 0x01, 0xb1, 0xde }, /* -19.5 dB */ 434 { 0x01, 0x99, 0x99 }, /* -20.0 dB */ 435 { 0x01, 0x82, 0xaf }, /* -20.5 dB */ 436 { 0x01, 0x6d, 0x0e }, /* -21.0 dB */ 437 { 0x01, 0x58, 0xa2 }, /* -21.5 dB */ 438 { 0x01, 0x45, 0x5b }, /* -22.0 dB */ 439 { 0x01, 0x33, 0x28 }, /* -22.5 dB */ 440 { 0x01, 0x21, 0xf9 }, /* -23.0 dB */ 441 { 0x01, 0x11, 0xc0 }, /* -23.5 dB */ 442 { 0x01, 0x02, 0x70 }, /* -24.0 dB */ 443 { 0x00, 0xf3, 0xfb }, /* -24.5 dB */ 444 { 0x00, 0xe6, 0x55 }, /* -25.0 dB */ 445 { 0x00, 0xd9, 0x73 }, /* -25.5 dB */ 446 { 0x00, 0xcd, 0x49 }, /* -26.0 dB */ 447 { 0x00, 0xc1, 0xcd }, /* -26.5 dB */ 448 { 0x00, 0xb6, 0xf6 }, /* -27.0 dB */ 449 { 0x00, 0xac, 0xba }, /* -27.5 dB */ 450 { 0x00, 0xa3, 0x10 }, /* -28.0 dB */ 451 { 0x00, 0x99, 0xf1 }, /* -28.5 dB */ 452 { 0x00, 0x91, 0x54 }, /* -29.0 dB */ 453 { 0x00, 0x89, 0x33 }, /* -29.5 dB */ 454 { 0x00, 0x81, 0x86 }, /* -30.0 dB */ 455 { 0x00, 0x7a, 0x48 }, /* -30.5 dB */ 456 { 0x00, 0x73, 0x70 }, /* -31.0 dB */ 457 { 0x00, 0x6c, 0xfb }, /* -31.5 dB */ 458 { 0x00, 0x66, 0xe3 }, /* -32.0 dB */ 459 { 0x00, 0x61, 0x21 }, /* -32.5 dB */ 460 { 0x00, 0x5b, 0xb2 }, /* -33.0 dB */ 461 { 0x00, 0x56, 0x91 }, /* -33.5 dB */ 462 { 0x00, 0x51, 0xb9 }, /* -34.0 dB */ 463 { 0x00, 0x4d, 0x27 }, /* -34.5 dB */ 464 { 0x00, 0x48, 0xd6 }, /* -35.0 dB */ 465 { 0x00, 0x44, 0xc3 }, /* -35.5 dB */ 466 { 0x00, 0x40, 0xea }, /* -36.0 dB */ 467 { 0x00, 0x3d, 0x49 }, /* -36.5 dB */ 468 { 0x00, 0x39, 0xdb }, /* -37.0 dB */ 469 { 0x00, 0x36, 0x9e }, /* -37.5 dB */ 470 { 0x00, 0x33, 0x90 }, /* -38.0 dB */ 471 { 0x00, 0x30, 0xae }, /* -38.5 dB */ 472 { 0x00, 0x2d, 0xf5 }, /* -39.0 dB */ 473 { 0x00, 0x2b, 0x63 }, /* -39.5 dB */ 474 { 0x00, 0x28, 0xf5 }, /* -40.0 dB */ 475 { 0x00, 0x26, 0xab }, /* -40.5 dB */ 476 { 0x00, 0x24, 0x81 }, /* -41.0 dB */ 477 { 0x00, 0x22, 0x76 }, /* -41.5 dB */ 478 { 0x00, 0x20, 0x89 }, /* -42.0 dB */ 479 { 0x00, 0x1e, 0xb7 }, /* -42.5 dB */ 480 { 0x00, 0x1c, 0xff }, /* -43.0 dB */ 481 { 0x00, 0x1b, 0x60 }, /* -43.5 dB */ 482 { 0x00, 0x19, 0xd8 }, /* -44.0 dB */ 483 { 0x00, 0x18, 0x65 }, /* -44.5 dB */ 484 { 0x00, 0x17, 0x08 }, /* -45.0 dB */ 485 { 0x00, 0x15, 0xbe }, /* -45.5 dB */ 486 { 0x00, 0x14, 0x87 }, /* -46.0 dB */ 487 { 0x00, 0x13, 0x61 }, /* -46.5 dB */ 488 { 0x00, 0x12, 0x4b }, /* -47.0 dB */ 489 { 0x00, 0x11, 0x45 }, /* -47.5 dB */ 490 { 0x00, 0x10, 0x4e }, /* -48.0 dB */ 491 { 0x00, 0x0f, 0x64 }, /* -48.5 dB */ 492 { 0x00, 0x0e, 0x88 }, /* -49.0 dB */ 493 { 0x00, 0x0d, 0xb8 }, /* -49.5 dB */ 494 { 0x00, 0x0c, 0xf3 }, /* -50.0 dB */ 495 { 0x00, 0x0c, 0x3a }, /* -50.5 dB */ 496 { 0x00, 0x0b, 0x8b }, /* -51.0 dB */ 497 { 0x00, 0x0a, 0xe5 }, /* -51.5 dB */ 498 { 0x00, 0x0a, 0x49 }, /* -52.0 dB */ 499 { 0x00, 0x09, 0xb6 }, /* -52.5 dB */ 500 { 0x00, 0x09, 0x2b }, /* -53.0 dB */ 501 { 0x00, 0x08, 0xa8 }, /* -53.5 dB */ 502 { 0x00, 0x08, 0x2c }, /* -54.0 dB */ 503 { 0x00, 0x07, 0xb7 }, /* -54.5 dB */ 504 { 0x00, 0x07, 0x48 }, /* -55.0 dB */ 505 { 0x00, 0x06, 0xe0 }, /* -55.5 dB */ 506 { 0x00, 0x06, 0x7d }, /* -56.0 dB */ 507 { 0x00, 0x06, 0x20 }, /* -56.5 dB */ 508 { 0x00, 0x05, 0xc9 }, /* -57.0 dB */ 509 { 0x00, 0x05, 0x76 }, /* -57.5 dB */ 510 { 0x00, 0x05, 0x28 }, /* -58.0 dB */ 511 { 0x00, 0x04, 0xde }, /* -58.5 dB */ 512 { 0x00, 0x04, 0x98 }, /* -59.0 dB */ 513 { 0x00, 0x04, 0x56 }, /* -59.5 dB */ 514 { 0x00, 0x04, 0x18 }, /* -60.0 dB */ 515 { 0x00, 0x03, 0xdd }, /* -60.5 dB */ 516 { 0x00, 0x03, 0xa6 }, /* -61.0 dB */ 517 { 0x00, 0x03, 0x72 }, /* -61.5 dB */ 518 { 0x00, 0x03, 0x40 }, /* -62.0 dB */ 519 { 0x00, 0x03, 0x12 }, /* -62.5 dB */ 520 { 0x00, 0x02, 0xe6 }, /* -63.0 dB */ 521 { 0x00, 0x02, 0xbc }, /* -63.5 dB */ 522 { 0x00, 0x02, 0x95 }, /* -64.0 dB */ 523 { 0x00, 0x02, 0x70 }, /* -64.5 dB */ 524 { 0x00, 0x02, 0x4d }, /* -65.0 dB */ 525 { 0x00, 0x02, 0x2c }, /* -65.5 dB */ 526 { 0x00, 0x02, 0x0d }, /* -66.0 dB */ 527 { 0x00, 0x01, 0xf0 }, /* -66.5 dB */ 528 { 0x00, 0x01, 0xd4 }, /* -67.0 dB */ 529 { 0x00, 0x01, 0xba }, /* -67.5 dB */ 530 { 0x00, 0x01, 0xa1 }, /* -68.0 dB */ 531 { 0x00, 0x01, 0x8a }, /* -68.5 dB */ 532 { 0x00, 0x01, 0x74 }, /* -69.0 dB */ 533 { 0x00, 0x01, 0x5f }, /* -69.5 dB */ 534 { 0x00, 0x01, 0x4b }, /* -70.0 dB */ 535 { 0x00, 0x00, 0x00 } /* Mute */ 536 }; 537 538 #define SNAPPER_NFORMATS 2 539 static const struct audio_format snapper_formats[SNAPPER_NFORMATS] = { 540 {NULL, AUMODE_PLAY | AUMODE_RECORD, AUDIO_ENCODING_SLINEAR_BE, 16, 16, 541 2, AUFMT_STEREO, 3, {32000, 44100, 48000}}, 542 {NULL, AUMODE_PLAY | AUMODE_RECORD, AUDIO_ENCODING_SLINEAR_BE, 24, 24, 543 2, AUFMT_STEREO, 3, {32000, 44100, 48000}}, 544 }; 545 546 #define TUMBLER_NFORMATS 1 547 static const struct audio_format tumbler_formats[TUMBLER_NFORMATS] = { 548 {NULL, AUMODE_PLAY | AUMODE_RECORD, AUDIO_ENCODING_SLINEAR_BE, 16, 16, 549 2, AUFMT_STEREO, 4, {32000, 44100, 48000, 96000}}, 550 }; 551 552 static u_char *amp_mute; 553 static u_char *headphone_mute; 554 static u_char *audio_hw_reset; 555 static u_char *headphone_detect; 556 static int headphone_detect_active; 557 558 559 /* I2S registers */ 560 #define I2S_INT 0x00 561 #define I2S_FORMAT 0x10 562 #define I2S_FRAMECOUNT 0x40 563 #define I2S_FRAMEMATCH 0x50 564 #define I2S_WORDSIZE 0x60 565 566 /* I2S_INT register definitions */ 567 #define I2S_INT_CLKSTOPPEND 0x01000000 /* clock-stop interrupt pending */ 568 569 /* FCR(0x3c) bits */ 570 #define KEYLARGO_FCR1 0x3c 571 #define I2S0CLKEN 0x1000 572 #define I2S0EN 0x2000 573 #define I2S1CLKEN 0x080000 574 #define I2S1EN 0x100000 575 #define FCR3C_BITMASK "\020\25I2S1EN\24I2S1CLKEN\16I2S0EN\15I2S0CLKEN" 576 577 /* TAS3004/TAS3001 registers */ 578 #define DEQ_MCR1 0x01 /* Main control register 1 (1byte) */ 579 #define DEQ_DRC 0x02 /* Dynamic range compression (6bytes?) 580 2 bytes (reserved) on the TAS 3001 */ 581 #define DEQ_VOLUME 0x04 /* Volume (6bytes) */ 582 #define DEQ_TREBLE 0x05 /* Treble control (1byte) */ 583 #define DEQ_BASS 0x06 /* Bass control (1byte) */ 584 #define DEQ_MIXER_L 0x07 /* Mixer left gain (9bytes; 3 on TAS3001) */ 585 #define DEQ_MIXER_R 0x08 /* Mixer right gain (9bytes; 3 on TAS3001) */ 586 #define DEQ_LB0 0x0a /* Left biquad 0 (15bytes) */ 587 #define DEQ_LB1 0x0b /* Left biquad 1 (15bytes) */ 588 #define DEQ_LB2 0x0c /* Left biquad 2 (15bytes) */ 589 #define DEQ_LB3 0x0d /* Left biquad 3 (15bytes) */ 590 #define DEQ_LB4 0x0e /* Left biquad 4 (15bytes) */ 591 #define DEQ_LB5 0x0f /* Left biquad 5 (15bytes) */ 592 #define DEQ_LB6 0x10 /* Left biquad 6 (15bytes) */ 593 #define DEQ_RB0 0x13 /* Right biquad 0 (15bytes) */ 594 #define DEQ_RB1 0x14 /* Right biquad 1 (15bytes) */ 595 #define DEQ_RB2 0x15 /* Right biquad 2 (15bytes) */ 596 #define DEQ_RB3 0x16 /* Right biquad 3 (15bytes) */ 597 #define DEQ_RB4 0x17 /* Right biquad 4 (15bytes) */ 598 #define DEQ_RB5 0x18 /* Right biquad 5 (15bytes) */ 599 #define DEQ_RB6 0x19 /* Right biquad 6 (15bytes) */ 600 #define DEQ_LLB 0x21 /* Left loudness biquad (15bytes) */ 601 #define DEQ_RLB 0x22 /* Right loudness biquad (15bytes) */ 602 #define DEQ_LLB_GAIN 0x23 /* Left loudness biquad gain (3bytes) */ 603 #define DEQ_RLB_GAIN 0x24 /* Right loudness biquad gain (3bytes) */ 604 #define DEQ_ACR 0x40 /* [TAS3004] Analog control register (1byte) */ 605 #define DEQ_MCR2 0x43 /* [TAS3004] Main control register 2 (1byte) */ 606 #define DEQ_MCR1_FL 0x80 /* Fast load */ 607 #define DEQ_MCR1_SC 0x40 /* SCLK frequency */ 608 #define DEQ_MCR1_SC_32 0x00 /* 32fs */ 609 #define DEQ_MCR1_SC_64 0x40 /* 64fs */ 610 #define DEQ_MCR1_SM 0x30 /* Output serial port mode */ 611 #define DEQ_MCR1_SM_L 0x00 /* Left justified */ 612 #define DEQ_MCR1_SM_R 0x10 /* Right justified */ 613 #define DEQ_MCR1_SM_I2S 0x20 /* I2S */ 614 #define DEQ_MCR1_ISM 0x0c /* [TAS3001] Input serial port mode */ 615 #define DEQ_MCR1_ISM_L 0x00 /* Left justified */ 616 #define DEQ_MCR1_ISM_R 0x04 /* Right justified */ 617 #define DEQ_MCR1_ISM_I2S 0x08 /* I2S */ 618 #define DEQ_MCR1_W 0x03 /* Serial port word length */ 619 #define DEQ_MCR1_W_16 0x00 /* 16 bit */ 620 #define DEQ_MCR1_W_18 0x01 /* 18 bit */ 621 #define DEQ_MCR1_W_20 0x02 /* 20 bit */ 622 #define DEQ_MCR1_W_24 0x03 /* 24 bit */ 623 624 #define DEQ_MCR2_DL 0x80 /* Download */ 625 #define DEQ_MCR2_AP 0x02 /* All pass mode */ 626 627 #define DEQ_ACR_ADM 0x80 /* ADC output mode */ 628 #define DEQ_ACR_LRB 0x40 /* Select B input */ 629 #define DEQ_ACR_DM 0x0c /* De-emphasis control */ 630 #define DEQ_ACR_DM_OFF 0x00 /* off */ 631 #define DEQ_ACR_DM_48 0x04 /* fs = 48kHz */ 632 #define DEQ_ACR_DM_44 0x08 /* fs = 44.1kHz */ 633 #define DEQ_ACR_INP 0x02 /* Analog input select */ 634 #define DEQ_ACR_INP_A 0x00 /* A */ 635 #define DEQ_ACR_INP_B 0x02 /* B */ 636 #define DEQ_ACR_APD 0x01 /* Analog power down */ 637 638 struct tas3004_reg { 639 u_char MCR1[1]; 640 u_char DRC[6]; 641 u_char VOLUME[6]; 642 u_char TREBLE[1]; 643 u_char BASS[1]; 644 u_char MIXER_L[9]; 645 u_char MIXER_R[9]; 646 u_char LB0[15]; 647 u_char LB1[15]; 648 u_char LB2[15]; 649 u_char LB3[15]; 650 u_char LB4[15]; 651 u_char LB5[15]; 652 u_char LB6[15]; 653 u_char RB0[15]; 654 u_char RB1[15]; 655 u_char RB2[15]; 656 u_char RB3[15]; 657 u_char RB4[15]; 658 u_char RB5[15]; 659 u_char RB6[15]; 660 u_char LLB[15]; 661 u_char RLB[15]; 662 u_char LLB_GAIN[3]; 663 u_char RLB_GAIN[3]; 664 u_char ACR[1]; 665 u_char MCR2[1]; 666 }; 667 668 #define GPIO_OUTSEL 0xf0 /* Output select */ 669 /* 0x00 GPIO bit0 is output 670 0x10 media-bay power 671 0x20 reserved 672 0x30 MPIC */ 673 674 #define GPIO_ALTOE 0x08 /* Alternate output enable */ 675 /* 0x00 Use DDR 676 0x08 Use output select */ 677 678 #define GPIO_DDR 0x04 /* Data direction */ 679 #define GPIO_DDR_OUTPUT 0x04 /* Output */ 680 #define GPIO_DDR_INPUT 0x00 /* Input */ 681 682 #define GPIO_LEVEL 0x02 /* Pin level (RO) */ 683 684 #define GPIO_DATA 0x01 /* Data */ 685 686 static int 687 snapper_match(device_t parent, struct cfdata *match, void *aux) 688 { 689 struct confargs *ca; 690 int soundbus, soundchip, soundcodec; 691 char compat[32]; 692 693 ca = aux; 694 if (strcmp(ca->ca_name, "i2s") != 0) 695 return 0; 696 697 if ((soundbus = OF_child(ca->ca_node)) == 0 || 698 (soundchip = OF_child(soundbus)) == 0) 699 return 0; 700 701 memset(compat, 0, sizeof compat); 702 OF_getprop(soundchip, "compatible", compat, sizeof compat); 703 704 if (strcmp(compat, "snapper") == 0) 705 return 1; 706 707 if (strcmp(compat, "tumbler") == 0) 708 return 1; 709 710 if (strcmp(compat, "AOAKeylargo") == 0) 711 return 1; 712 713 if (strcmp(compat, "AOAK2") == 0) 714 return 1; 715 716 if (OF_getprop(soundchip, "platform-tas-codec-ref", 717 &soundcodec, sizeof soundcodec) == sizeof soundcodec) 718 return 1; 719 720 return 0; 721 } 722 723 static void 724 snapper_attach(device_t parent, device_t self, void *aux) 725 { 726 struct snapper_softc *sc; 727 struct confargs *ca; 728 int cirq, oirq, iirq, /*cirq_type,*/ oirq_type, iirq_type, soundbus; 729 uint32_t intr[6], reg[6]; 730 char compat[32]; 731 732 sc = device_private(self); 733 sc->sc_dev = self; 734 735 ca = aux; 736 737 soundbus = OF_child(ca->ca_node); 738 memset(compat, 0, sizeof compat); 739 OF_getprop(OF_child(soundbus), "compatible", compat, sizeof compat); 740 741 if (strcmp(compat, "tumbler") == 0) 742 sc->sc_mode = SNAPPER_IS_TAS3001; 743 744 if (sc->sc_mode == SNAPPER_IS_TAS3001) { 745 if (auconv_create_encodings(tumbler_formats, TUMBLER_NFORMATS, 746 &sc->sc_encodings) != 0) { 747 aprint_normal("can't create encodings\n"); 748 return; 749 } 750 } else { 751 if (auconv_create_encodings(snapper_formats, SNAPPER_NFORMATS, 752 &sc->sc_encodings) != 0) { 753 aprint_normal("can't create encodings\n"); 754 return; 755 } 756 } 757 758 sc->sc_odmacmd = dbdma_alloc((SNAPPER_MAXPAGES + 4) * 759 sizeof(struct dbdma_command), NULL); 760 sc->sc_idmacmd = dbdma_alloc((SNAPPER_MAXPAGES + 4) * 761 sizeof(struct dbdma_command), NULL); 762 763 sc->sc_baseaddr = ca->ca_baseaddr; 764 OF_getprop(soundbus, "reg", reg, sizeof reg); 765 reg[0] += ca->ca_baseaddr; 766 reg[2] += ca->ca_baseaddr; 767 reg[4] += ca->ca_baseaddr; 768 769 sc->sc_node = ca->ca_node; 770 sc->sc_tag = ca->ca_tag; 771 772 bus_space_map(sc->sc_tag, reg[0], reg[1], 0, &sc->sc_bsh); 773 bus_space_map(sc->sc_tag, reg[2], reg[3], 774 BUS_SPACE_MAP_LINEAR, &sc->sc_odmah); 775 bus_space_map(sc->sc_tag, reg[4], reg[5], 776 BUS_SPACE_MAP_LINEAR, &sc->sc_idmah); 777 778 sc->sc_odma = bus_space_vaddr(sc->sc_tag, sc->sc_odmah); 779 sc->sc_idma = bus_space_vaddr(sc->sc_tag, sc->sc_idmah); 780 781 OF_getprop(soundbus, "interrupts", intr, sizeof intr); 782 cirq = intr[0]; 783 oirq = intr[2]; 784 iirq = intr[4]; 785 /* cirq_type = intr[1] ? IST_LEVEL : IST_EDGE; */ 786 oirq_type = intr[3] ? IST_LEVEL : IST_EDGE; 787 iirq_type = intr[5] ? IST_LEVEL : IST_EDGE; 788 789 /* intr_establish(cirq, cirq_type, IPL_AUDIO, snapper_intr, sc); */ 790 intr_establish(oirq, oirq_type, IPL_AUDIO, snapper_intr, sc); 791 intr_establish(iirq, iirq_type, IPL_AUDIO, snapper_intr, sc); 792 793 aprint_normal(": irq %d,%d,%d\n", cirq, oirq, iirq); 794 795 mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE); 796 mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_AUDIO); 797 798 /* PMF event handler */ 799 pmf_device_register(sc->sc_dev, NULL, NULL); 800 801 config_defer(self, snapper_defer); 802 } 803 804 static void 805 snapper_defer(device_t dev) 806 { 807 struct snapper_softc *sc; 808 device_t dv; 809 deviter_t di; 810 struct deq_softc *deq; 811 812 sc = device_private(dev); 813 for (dv = deviter_first(&di, DEVITER_F_ROOT_FIRST); 814 dv != NULL; 815 dv = deviter_next(&di)) { 816 if (device_is_a(dv, "deq")) { 817 deq = device_private(dv); 818 sc->sc_i2c = deq->sc_i2c; 819 sc->sc_deqaddr = deq->sc_address; 820 } 821 } 822 deviter_release(&di); 823 824 /* If we don't find a codec, it's not the end of the world; 825 * we can control the volume in software in this case. 826 */ 827 if (sc->sc_i2c == NULL) 828 sc->sc_mode = SNAPPER_SWVOL; 829 830 switch (sc->sc_mode) { 831 case SNAPPER_SWVOL: 832 aprint_verbose("%s: software codec\n", device_xname(dev)); 833 break; 834 case SNAPPER_IS_TAS3001: 835 aprint_verbose("%s: codec: TAS3001\n", device_xname(dev)); 836 break; 837 case 0: 838 aprint_verbose("%s: codec: TAS3004\n", device_xname(dev)); 839 break; 840 } 841 842 snapper_init(sc, sc->sc_node); 843 844 audio_attach_mi(&snapper_hw_if, sc, sc->sc_dev); 845 } 846 847 static int 848 snapper_intr(void *v) 849 { 850 struct snapper_softc *sc; 851 struct dbdma_command *cmd; 852 int count; 853 int status; 854 855 sc = v; 856 mutex_spin_enter(&sc->sc_intr_lock); 857 cmd = sc->sc_odmacmd; 858 count = sc->sc_opages; 859 /* Fill used buffer(s). */ 860 while (count-- > 0) { 861 if ((in16rb(&cmd->d_command) & 0x30) == 0x30) { 862 status = in16rb(&cmd->d_status); 863 cmd->d_status = 0; 864 if (status) /* status == 0x8400 */ 865 if (sc->sc_ointr) 866 (*sc->sc_ointr)(sc->sc_oarg); 867 } 868 cmd++; 869 } 870 871 cmd = sc->sc_idmacmd; 872 count = sc->sc_ipages; 873 while (count-- > 0) { 874 if ((in16rb(&cmd->d_command) & 0x30) == 0x30) { 875 status = in16rb(&cmd->d_status); 876 cmd->d_status = 0; 877 if (status) /* status == 0x8400 */ 878 if (sc->sc_iintr) 879 (*sc->sc_iintr)(sc->sc_iarg); 880 } 881 cmd++; 882 } 883 mutex_spin_exit(&sc->sc_intr_lock); 884 885 return 1; 886 } 887 888 889 static int 890 snapper_query_encoding(void *h, struct audio_encoding *ae) 891 { 892 893 struct snapper_softc *sc = h; 894 895 return auconv_query_encoding(sc->sc_encodings, ae); 896 } 897 898 static int 899 snapper_set_params(void *h, int setmode, int usemode, 900 audio_params_t *play, audio_params_t *rec, 901 stream_filter_list_t *pfil, stream_filter_list_t *rfil) 902 { 903 struct snapper_softc *sc; 904 audio_params_t *p; 905 stream_filter_list_t *fil = NULL; /* XXX gcc */ 906 int mode; 907 908 sc = h; 909 p = NULL; 910 911 /* 912 * This device only has one clock, so make the sample rates match. 913 */ 914 if (play->sample_rate != rec->sample_rate && 915 usemode == (AUMODE_PLAY | AUMODE_RECORD)) { 916 if (setmode == AUMODE_PLAY) { 917 rec->sample_rate = play->sample_rate; 918 setmode |= AUMODE_RECORD; 919 } else if (setmode == AUMODE_RECORD) { 920 play->sample_rate = rec->sample_rate; 921 setmode |= AUMODE_PLAY; 922 } else 923 return EINVAL; 924 } 925 926 for (mode = AUMODE_RECORD; mode != -1; 927 mode = mode == AUMODE_RECORD ? AUMODE_PLAY : -1) { 928 if ((setmode & mode) == 0) 929 continue; 930 931 p = mode == AUMODE_PLAY ? play : rec; 932 fil = mode == AUMODE_PLAY ? pfil : rfil; 933 if (sc->sc_mode == SNAPPER_IS_TAS3001) { 934 if (auconv_set_converter(tumbler_formats, 935 TUMBLER_NFORMATS, mode, p, true, fil) < 0) { 936 DPRINTF("snapper_set_params: " 937 "auconv_set_converter failed\n"); 938 return EINVAL; 939 } 940 } else { /* TAS 3004 */ 941 if (auconv_set_converter(snapper_formats, 942 SNAPPER_NFORMATS, mode, p, true, fil) < 0) { 943 DPRINTF("snapper_set_params: " 944 "auconv_set_converter failed\n"); 945 return EINVAL; 946 } 947 } 948 949 if (fil->req_size > 0) 950 p = &fil->filters[0].param; 951 if (p->precision == 16) { 952 if (sc->sc_mode == SNAPPER_SWVOL) 953 fil->prepend(fil, snapper_volume, p); 954 else if (sc->sc_mode == 0 && p->channels == 2) { 955 /* 956 * Fix phase problems on TAS3004. 957 * This filter must go last on the chain, 958 * so prepend it, not append it. 959 */ 960 fil->prepend(fil, snapper_fixphase, p); 961 } 962 } 963 } 964 965 /* Set the speed. p points HW encoding. */ 966 if (p) { 967 sc->sc_rate = p->sample_rate; 968 sc->sc_bitspersample = p->precision; 969 } 970 return 0; 971 } 972 973 static int 974 snapper_round_blocksize(void *h, int size, int mode, 975 const audio_params_t *param) 976 { 977 978 if (size < NBPG) 979 size = NBPG; 980 return size & ~PGOFSET; 981 } 982 983 static int 984 snapper_halt_output(void *h) 985 { 986 struct snapper_softc *sc; 987 988 sc = h; 989 dbdma_stop(sc->sc_odma); 990 dbdma_reset(sc->sc_odma); 991 sc->sc_ointr = NULL; 992 return 0; 993 } 994 995 static int 996 snapper_halt_input(void *h) 997 { 998 struct snapper_softc *sc; 999 1000 sc = h; 1001 dbdma_stop(sc->sc_idma); 1002 dbdma_reset(sc->sc_idma); 1003 sc->sc_iintr = NULL; 1004 return 0; 1005 } 1006 1007 static int 1008 snapper_getdev(void *h, struct audio_device *retp) 1009 { 1010 1011 *retp = snapper_device; 1012 return 0; 1013 } 1014 1015 enum { 1016 SNAPPER_MONITOR_CLASS, 1017 SNAPPER_OUTPUT_CLASS, 1018 SNAPPER_RECORD_CLASS, 1019 SNAPPER_OUTPUT_SELECT, 1020 SNAPPER_VOL_OUTPUT, 1021 SNAPPER_DIGI1, 1022 SNAPPER_DIGI2, 1023 SNAPPER_VOL_INPUT, 1024 SNAPPER_TREBLE, 1025 SNAPPER_BASS, 1026 /* From this point, unsupported by the TAS 3001 */ 1027 SNAPPER_ANALOG, 1028 SNAPPER_INPUT_SELECT, 1029 SNAPPER_ENUM_LAST 1030 }; 1031 1032 static int 1033 snapper_set_port(void *h, mixer_ctrl_t *mc) 1034 { 1035 struct snapper_softc *sc; 1036 int l, r; 1037 u_char data; 1038 1039 DPRINTF("snapper_set_port dev = %d, type = %d\n", mc->dev, mc->type); 1040 sc = h; 1041 l = mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT]; 1042 r = mc->un.value.level[AUDIO_MIXER_LEVEL_RIGHT]; 1043 1044 switch (mc->dev) { 1045 case SNAPPER_OUTPUT_SELECT: 1046 /* No change necessary? */ 1047 if (mc->un.mask == sc->sc_output_mask) 1048 return 0; 1049 1050 snapper_mute_speaker(sc, 1); 1051 snapper_mute_headphone(sc, 1); 1052 if (mc->un.mask & 1 << 0) 1053 snapper_mute_speaker(sc, 0); 1054 if (mc->un.mask & 1 << 1) 1055 snapper_mute_headphone(sc, 0); 1056 1057 sc->sc_output_mask = mc->un.mask; 1058 return 0; 1059 1060 case SNAPPER_VOL_OUTPUT: 1061 snapper_set_volume(sc, l, r); 1062 return 0; 1063 1064 case SNAPPER_INPUT_SELECT: 1065 if (sc->sc_mode != 0) 1066 return ENXIO; 1067 1068 /* no change necessary? */ 1069 if (mc->un.mask == sc->sc_record_source) 1070 return 0; 1071 switch (mc->un.mask) { 1072 case 1 << 0: /* microphone */ 1073 /* Select right channel of B input */ 1074 data = DEQ_ACR_ADM | DEQ_ACR_LRB | DEQ_ACR_INP_B; 1075 tas3004_write(sc, DEQ_ACR, &data); 1076 break; 1077 case 1 << 1: /* line in */ 1078 /* Select both channels of A input */ 1079 data = 0; 1080 tas3004_write(sc, DEQ_ACR, &data); 1081 break; 1082 default: /* invalid argument */ 1083 return EINVAL; 1084 } 1085 sc->sc_record_source = mc->un.mask; 1086 return 0; 1087 1088 case SNAPPER_VOL_INPUT: 1089 /* XXX TO BE DONE */ 1090 return 0; 1091 1092 case SNAPPER_BASS: 1093 if (sc->sc_mode == SNAPPER_SWVOL) 1094 return ENXIO; 1095 snapper_set_bass(sc, l); 1096 return 0; 1097 case SNAPPER_TREBLE: 1098 if (sc->sc_mode == SNAPPER_SWVOL) 1099 return ENXIO; 1100 snapper_set_treble(sc, l); 1101 return 0; 1102 case SNAPPER_DIGI1: 1103 if (sc->sc_mode == SNAPPER_SWVOL) 1104 return ENXIO; 1105 1106 sc->mixer[0] = l; 1107 sc->mixer[3] = r; 1108 snapper_write_mixers(sc); 1109 return 0; 1110 case SNAPPER_DIGI2: 1111 if (sc->sc_mode == SNAPPER_SWVOL) 1112 return ENXIO; 1113 1114 if (sc->sc_mode == SNAPPER_IS_TAS3001) 1115 sc->mixer[3] = l; 1116 else { 1117 sc->mixer[1] = l; 1118 sc->mixer[4] = r; 1119 } 1120 snapper_write_mixers(sc); 1121 return 0; 1122 case SNAPPER_ANALOG: 1123 if (sc->sc_mode != 0) 1124 return ENXIO; 1125 1126 sc->mixer[2] = l; 1127 sc->mixer[5] = r; 1128 snapper_write_mixers(sc); 1129 return 0; 1130 } 1131 return ENXIO; 1132 } 1133 1134 static int 1135 snapper_get_port(void *h, mixer_ctrl_t *mc) 1136 { 1137 struct snapper_softc *sc; 1138 1139 DPRINTF("snapper_get_port dev = %d, type = %d\n", mc->dev, mc->type); 1140 sc = h; 1141 switch (mc->dev) { 1142 case SNAPPER_OUTPUT_SELECT: 1143 mc->un.mask = sc->sc_output_mask; 1144 return 0; 1145 1146 case SNAPPER_VOL_OUTPUT: 1147 mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT] = sc->sc_vol_l; 1148 mc->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] = sc->sc_vol_r; 1149 return 0; 1150 1151 case SNAPPER_INPUT_SELECT: 1152 if (sc->sc_mode != 0) 1153 return ENXIO; 1154 1155 mc->un.mask = sc->sc_record_source; 1156 return 0; 1157 1158 case SNAPPER_VOL_INPUT: 1159 /* XXX TO BE DONE */ 1160 mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT] = 0; 1161 mc->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] = 0; 1162 return 0; 1163 1164 case SNAPPER_TREBLE: 1165 if (sc->sc_mode == SNAPPER_SWVOL) 1166 return ENXIO; 1167 mc->un.value.level[AUDIO_MIXER_LEVEL_MONO] = sc->sc_treble; 1168 return 0; 1169 case SNAPPER_BASS: 1170 if (sc->sc_mode == SNAPPER_SWVOL) 1171 return ENXIO; 1172 mc->un.value.level[AUDIO_MIXER_LEVEL_MONO] = sc->sc_bass; 1173 return 0; 1174 1175 case SNAPPER_DIGI1: 1176 if (sc->sc_mode == SNAPPER_SWVOL) 1177 return ENXIO; 1178 1179 mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT] = sc->mixer[0]; 1180 mc->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] = sc->mixer[3]; 1181 return 0; 1182 case SNAPPER_DIGI2: 1183 if (sc->sc_mode == SNAPPER_SWVOL) 1184 return ENXIO; 1185 1186 mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT] = sc->mixer[1]; 1187 mc->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] = sc->mixer[4]; 1188 return 0; 1189 case SNAPPER_ANALOG: 1190 if (sc->sc_mode != 0) 1191 return ENXIO; 1192 1193 mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT] = sc->mixer[2]; 1194 mc->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] = sc->mixer[5]; 1195 return 0; 1196 default: 1197 return ENXIO; 1198 } 1199 1200 return 0; 1201 } 1202 1203 static int 1204 snapper_query_devinfo(void *h, mixer_devinfo_t *dip) 1205 { 1206 struct snapper_softc *sc = h; 1207 1208 switch (dip->index) { 1209 1210 case SNAPPER_OUTPUT_SELECT: 1211 dip->mixer_class = SNAPPER_OUTPUT_CLASS; 1212 strcpy(dip->label.name, AudioNoutput); 1213 dip->type = AUDIO_MIXER_SET; 1214 dip->prev = dip->next = AUDIO_MIXER_LAST; 1215 dip->un.s.num_mem = 2; 1216 strcpy(dip->un.s.member[0].label.name, AudioNspeaker); 1217 dip->un.s.member[0].mask = 1 << 0; 1218 strcpy(dip->un.s.member[1].label.name, AudioNheadphone); 1219 dip->un.s.member[1].mask = 1 << 1; 1220 return 0; 1221 1222 case SNAPPER_VOL_OUTPUT: 1223 dip->mixer_class = SNAPPER_OUTPUT_CLASS; 1224 strcpy(dip->label.name, AudioNmaster); 1225 dip->type = AUDIO_MIXER_VALUE; 1226 dip->prev = dip->next = AUDIO_MIXER_LAST; 1227 dip->un.v.num_channels = 2; 1228 dip->un.v.delta = 16; 1229 strcpy(dip->un.v.units.name, AudioNvolume); 1230 return 0; 1231 1232 case SNAPPER_INPUT_SELECT: 1233 if (sc->sc_mode != 0) 1234 return ENXIO; 1235 1236 dip->mixer_class = SNAPPER_RECORD_CLASS; 1237 strcpy(dip->label.name, AudioNsource); 1238 dip->type = AUDIO_MIXER_SET; 1239 dip->prev = dip->next = AUDIO_MIXER_LAST; 1240 dip->un.s.num_mem = 2; 1241 strcpy(dip->un.s.member[0].label.name, AudioNmicrophone); 1242 dip->un.s.member[0].mask = 1 << 0; 1243 strcpy(dip->un.s.member[1].label.name, AudioNline); 1244 dip->un.s.member[1].mask = 1 << 1; 1245 return 0; 1246 1247 case SNAPPER_VOL_INPUT: 1248 dip->mixer_class = SNAPPER_RECORD_CLASS; 1249 strcpy(dip->label.name, AudioNrecord); 1250 dip->type = AUDIO_MIXER_VALUE; 1251 dip->prev = dip->next = AUDIO_MIXER_LAST; 1252 dip->un.v.num_channels = 2; 1253 strcpy(dip->un.v.units.name, AudioNvolume); 1254 return 0; 1255 1256 case SNAPPER_MONITOR_CLASS: 1257 dip->mixer_class = SNAPPER_MONITOR_CLASS; 1258 strcpy(dip->label.name, AudioCmonitor); 1259 dip->type = AUDIO_MIXER_CLASS; 1260 dip->next = dip->prev = AUDIO_MIXER_LAST; 1261 return 0; 1262 1263 case SNAPPER_OUTPUT_CLASS: 1264 dip->mixer_class = SNAPPER_OUTPUT_CLASS; 1265 strcpy(dip->label.name, AudioCoutputs); 1266 dip->type = AUDIO_MIXER_CLASS; 1267 dip->next = dip->prev = AUDIO_MIXER_LAST; 1268 return 0; 1269 1270 case SNAPPER_RECORD_CLASS: 1271 dip->mixer_class = SNAPPER_RECORD_CLASS; 1272 strcpy(dip->label.name, AudioCrecord); 1273 dip->type = AUDIO_MIXER_CLASS; 1274 dip->next = dip->prev = AUDIO_MIXER_LAST; 1275 return 0; 1276 1277 case SNAPPER_TREBLE: 1278 if (sc->sc_mode == SNAPPER_SWVOL) 1279 return ENXIO; 1280 1281 dip->mixer_class = SNAPPER_OUTPUT_CLASS; 1282 strcpy(dip->label.name, AudioNtreble); 1283 dip->type = AUDIO_MIXER_VALUE; 1284 dip->prev = dip->next = AUDIO_MIXER_LAST; 1285 dip->un.v.num_channels = 1; 1286 return 0; 1287 1288 case SNAPPER_BASS: 1289 if (sc->sc_mode == SNAPPER_SWVOL) 1290 return ENXIO; 1291 1292 dip->mixer_class = SNAPPER_OUTPUT_CLASS; 1293 strcpy(dip->label.name, AudioNbass); 1294 dip->type = AUDIO_MIXER_VALUE; 1295 dip->prev = dip->next = AUDIO_MIXER_LAST; 1296 dip->un.v.num_channels = 1; 1297 return 0; 1298 1299 case SNAPPER_DIGI1: 1300 if (sc->sc_mode == SNAPPER_SWVOL) 1301 return ENXIO; 1302 1303 dip->mixer_class = SNAPPER_OUTPUT_CLASS; 1304 strcpy(dip->label.name, AudioNdac); 1305 dip->type = AUDIO_MIXER_VALUE; 1306 dip->prev = dip->next = AUDIO_MIXER_LAST; 1307 dip->un.v.num_channels = 1308 sc->sc_mode == SNAPPER_IS_TAS3001? 1 : 2; 1309 return 0; 1310 case SNAPPER_DIGI2: 1311 if (sc->sc_mode == SNAPPER_SWVOL) 1312 return ENXIO; 1313 1314 dip->mixer_class = SNAPPER_OUTPUT_CLASS; 1315 strcpy(dip->label.name, AudioNline); 1316 dip->type = AUDIO_MIXER_VALUE; 1317 dip->prev = dip->next = AUDIO_MIXER_LAST; 1318 dip->un.v.num_channels = 1319 sc->sc_mode == SNAPPER_IS_TAS3001? 1 : 2; 1320 return 0; 1321 case SNAPPER_ANALOG: 1322 if (sc->sc_mode != 0) 1323 return ENXIO; 1324 1325 dip->mixer_class = SNAPPER_MONITOR_CLASS; 1326 strcpy(dip->label.name, AudioNmicrophone); 1327 dip->type = AUDIO_MIXER_VALUE; 1328 dip->prev = dip->next = AUDIO_MIXER_LAST; 1329 dip->un.v.num_channels = 2; 1330 return 0; 1331 } 1332 1333 return ENXIO; 1334 } 1335 1336 static size_t 1337 snapper_round_buffersize(void *h, int dir, size_t size) 1338 { 1339 1340 if (size > 65536) 1341 size = 65536; 1342 return size; 1343 } 1344 1345 static paddr_t 1346 snapper_mappage(void *h, void *mem, off_t off, int prot) 1347 { 1348 1349 if (off < 0) 1350 return -1; 1351 return -1; /* XXX */ 1352 } 1353 1354 static int 1355 snapper_get_props(void *h) 1356 { 1357 return AUDIO_PROP_FULLDUPLEX /* | AUDIO_PROP_MMAP */; 1358 } 1359 1360 static int 1361 snapper_trigger_output(void *h, void *start, void *end, int bsize, 1362 void (*intr)(void *), void *arg, 1363 const audio_params_t *param) 1364 { 1365 struct snapper_softc *sc; 1366 struct dbdma_command *cmd; 1367 vaddr_t va; 1368 int i, len, intmode; 1369 int res; 1370 1371 DPRINTF("trigger_output %p %p 0x%x\n", start, end, bsize); 1372 sc = h; 1373 1374 if ((res = snapper_set_rate(sc)) != 0) 1375 return res; 1376 1377 cmd = sc->sc_odmacmd; 1378 sc->sc_ointr = intr; 1379 sc->sc_oarg = arg; 1380 sc->sc_opages = ((char *)end - (char *)start) / NBPG; 1381 1382 #ifdef DIAGNOSTIC 1383 if (sc->sc_opages > SNAPPER_MAXPAGES) 1384 panic("snapper_trigger_output"); 1385 #endif 1386 1387 va = (vaddr_t)start; 1388 len = 0; 1389 for (i = sc->sc_opages; i > 0; i--) { 1390 len += NBPG; 1391 if (len < bsize) 1392 intmode = 0; 1393 else { 1394 len = 0; 1395 intmode = DBDMA_INT_ALWAYS; 1396 } 1397 1398 DBDMA_BUILD(cmd, DBDMA_CMD_OUT_MORE, 0, NBPG, vtophys(va), 1399 intmode, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER); 1400 cmd++; 1401 va += NBPG; 1402 } 1403 1404 DBDMA_BUILD(cmd, DBDMA_CMD_NOP, 0, 0, 1405 0/*vtophys((vaddr_t)sc->sc_odmacmd)*/, 0, DBDMA_WAIT_NEVER, 1406 DBDMA_BRANCH_ALWAYS); 1407 1408 out32rb(&cmd->d_cmddep, vtophys((vaddr_t)sc->sc_odmacmd)); 1409 1410 dbdma_start(sc->sc_odma, sc->sc_odmacmd); 1411 1412 return 0; 1413 } 1414 1415 static int 1416 snapper_trigger_input(void *h, void *start, void *end, int bsize, 1417 void (*intr)(void *), void *arg, 1418 const audio_params_t *param) 1419 { 1420 struct snapper_softc *sc; 1421 struct dbdma_command *cmd; 1422 vaddr_t va; 1423 int i, len, intmode; 1424 int res; 1425 1426 DPRINTF("trigger_input %p %p 0x%x\n", start, end, bsize); 1427 sc = h; 1428 1429 if ((res = snapper_set_rate(sc)) != 0) 1430 return res; 1431 1432 cmd = sc->sc_idmacmd; 1433 sc->sc_iintr = intr; 1434 sc->sc_iarg = arg; 1435 sc->sc_ipages = ((char *)end - (char *)start) / NBPG; 1436 1437 #ifdef DIAGNOSTIC 1438 if (sc->sc_ipages > SNAPPER_MAXPAGES) 1439 panic("snapper_trigger_input"); 1440 #endif 1441 1442 va = (vaddr_t)start; 1443 len = 0; 1444 for (i = sc->sc_ipages; i > 0; i--) { 1445 len += NBPG; 1446 if (len < bsize) 1447 intmode = 0; 1448 else { 1449 len = 0; 1450 intmode = DBDMA_INT_ALWAYS; 1451 } 1452 1453 DBDMA_BUILD(cmd, DBDMA_CMD_IN_MORE, 0, NBPG, vtophys(va), 1454 intmode, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER); 1455 cmd++; 1456 va += NBPG; 1457 } 1458 1459 DBDMA_BUILD(cmd, DBDMA_CMD_NOP, 0, 0, 1460 0/*vtophys((vaddr_t)sc->sc_odmacmd)*/, 0, DBDMA_WAIT_NEVER, 1461 DBDMA_BRANCH_ALWAYS); 1462 1463 out32rb(&cmd->d_cmddep, vtophys((vaddr_t)sc->sc_idmacmd)); 1464 1465 dbdma_start(sc->sc_idma, sc->sc_idmacmd); 1466 1467 return 0; 1468 } 1469 1470 static void 1471 snapper_get_locks(void *opaque, kmutex_t **intr, kmutex_t **thread) 1472 { 1473 struct snapper_softc *sc = opaque; 1474 1475 *intr = &sc->sc_intr_lock; 1476 *thread = &sc->sc_lock; 1477 } 1478 1479 static void 1480 snapper_set_volume(struct snapper_softc *sc, u_int left, u_int right) 1481 { 1482 u_char regs[6]; 1483 int l, r; 1484 1485 left = min(255, left); 1486 right = min(255, right); 1487 1488 if (sc->sc_mode == SNAPPER_SWVOL) { 1489 snapper_vol_l = left; 1490 snapper_vol_r = right; 1491 } else { 1492 /* 1493 * for some insane reason the gain table for master volume and the 1494 * mixer channels is almost identical - just shifted by 4 bits 1495 * so we use the mixer_gain table and bit-twiddle it... 1496 */ 1497 l = 177 - (left * 178 / 256); 1498 regs[0] = (snapper_mixer_gain[l][0] >> 4); 1499 regs[1] = ((snapper_mixer_gain[l][0] & 0x0f) << 4) | 1500 (snapper_mixer_gain[l][1] >> 4); 1501 regs[2] = ((snapper_mixer_gain[l][1] & 0x0f) << 4) | 1502 (snapper_mixer_gain[l][2] >> 4); 1503 1504 r = 177 - (right * 178 / 256); 1505 regs[3] = (snapper_mixer_gain[r][0] >> 4); 1506 regs[4] = ((snapper_mixer_gain[r][0] & 0x0f) << 4) | 1507 (snapper_mixer_gain[r][1] >> 4); 1508 regs[5] = ((snapper_mixer_gain[r][1] & 0x0f) << 4) | 1509 (snapper_mixer_gain[r][2] >> 4); 1510 1511 tas3004_write(sc, DEQ_VOLUME, regs); 1512 1513 DPRINTF("%d %02x %02x %02x : %d %02x %02x %02x\n", l, regs[0], 1514 regs[1], regs[2], r, regs[3], regs[4], regs[5]); 1515 } 1516 1517 sc->sc_vol_l = left; 1518 sc->sc_vol_r = right; 1519 } 1520 1521 static void 1522 snapper_set_basstreble(struct snapper_softc *sc, u_int val, u_int mode) 1523 { 1524 int i = val & 0xFF; 1525 uint8_t reg; 1526 1527 /* 1528 * Make 128 match the 0 dB point 1529 */ 1530 i = (i - (128 - (SNAPPER_BASSTAB_0DB << 2))) >> 2; 1531 if (i < 0) 1532 i = 0; 1533 else if (i >= sizeof(snapper_basstab)) 1534 i = sizeof(snapper_basstab) - 1; 1535 reg = snapper_basstab[i]; 1536 1537 if (sc->sc_mode == SNAPPER_IS_TAS3001 && 1538 mode == DEQ_BASS) { 1539 /* 1540 * XXX -- The TAS3001 bass table is different 1541 * than the other tables. 1542 */ 1543 reg = (reg >> 1) + 5; // map 0x72 -> 0x3E (0 dB) 1544 } 1545 1546 tas3004_write(sc, mode, ®); 1547 } 1548 1549 static void 1550 snapper_set_treble(struct snapper_softc *sc, u_int val) 1551 { 1552 if (sc->sc_treble != (u_char)val) { 1553 sc->sc_treble = val; 1554 snapper_set_basstreble(sc, val, DEQ_TREBLE); 1555 } 1556 } 1557 1558 static void 1559 snapper_set_bass(struct snapper_softc *sc, u_int val) 1560 { 1561 if (sc->sc_bass != (u_char)val) { 1562 sc->sc_bass = val; 1563 snapper_set_basstreble(sc, val, DEQ_BASS); 1564 } 1565 } 1566 1567 1568 /* 1569 * In the mixer gain setting, make 128 correspond to 1570 * the 0dB value from the table. 1571 * Note that the table values are complemented. 1572 */ 1573 #define SNAPPER_MIXER_GAIN_SIZE (sizeof(snapper_mixer_gain) / \ 1574 sizeof(snapper_mixer_gain[0])) 1575 #define NORMALIZE(i) ((~(i) & 0xff) - ((~128 & 0xff) - SNAPPER_MIXER_GAIN_0DB)) 1576 #define ADJUST(v, i) do { \ 1577 (v) = NORMALIZE(i);\ 1578 if ((v) < 0) \ 1579 (v) = 0; \ 1580 else if ((v) >= SNAPPER_MIXER_GAIN_SIZE) \ 1581 (v) = SNAPPER_MIXER_GAIN_SIZE - 1; \ 1582 \ 1583 } while (0) 1584 static void 1585 snapper_write_mixers(struct snapper_softc *sc) 1586 { 1587 uint8_t regs[9] = {0, 0, 0, 0, 0, 0, 0, 0, 0}; 1588 int i; 1589 1590 /* Left channel of SDIN1 */ 1591 ADJUST(i, sc->mixer[0]); 1592 regs[0] = snapper_mixer_gain[i][0]; 1593 regs[1] = snapper_mixer_gain[i][1]; 1594 regs[2] = snapper_mixer_gain[i][2]; 1595 1596 /* Left channel of SDIN2 */ 1597 ADJUST(i, sc->mixer[1]); 1598 regs[3] = snapper_mixer_gain[i][0]; 1599 regs[4] = snapper_mixer_gain[i][1]; 1600 regs[5] = snapper_mixer_gain[i][2]; 1601 1602 /* Left channel of analog input */ 1603 ADJUST(i, sc->mixer[2]); 1604 regs[6] = snapper_mixer_gain[i][0]; 1605 regs[7] = snapper_mixer_gain[i][1]; 1606 regs[8] = snapper_mixer_gain[i][2]; 1607 1608 tas3004_write(sc, DEQ_MIXER_L, regs); 1609 1610 /* Right channel of SDIN1 */ 1611 ADJUST(i, sc->mixer[3]); 1612 regs[0] = snapper_mixer_gain[i][0]; 1613 regs[1] = snapper_mixer_gain[i][1]; 1614 regs[2] = snapper_mixer_gain[i][2]; 1615 1616 /* Right channel of SDIN2 */ 1617 ADJUST(i, sc->mixer[4]); 1618 regs[3] = snapper_mixer_gain[i][0]; 1619 regs[4] = snapper_mixer_gain[i][1]; 1620 regs[5] = snapper_mixer_gain[i][2]; 1621 1622 /* Right channel of analog input */ 1623 ADJUST(i, sc->mixer[5]); 1624 regs[6] = snapper_mixer_gain[i][0]; 1625 regs[7] = snapper_mixer_gain[i][1]; 1626 regs[8] = snapper_mixer_gain[i][2]; 1627 1628 tas3004_write(sc, DEQ_MIXER_R, regs); 1629 } 1630 1631 #define CLKSRC_49MHz 0x80000000 /* Use 49152000Hz Osc. */ 1632 #define CLKSRC_45MHz 0x40000000 /* Use 45158400Hz Osc. */ 1633 #define CLKSRC_18MHz 0x00000000 /* Use 18432000Hz Osc. */ 1634 #define MCLK_DIV 0x1f000000 /* MCLK = SRC / DIV */ 1635 #define MCLK_DIV1 0x14000000 /* MCLK = SRC */ 1636 #define MCLK_DIV3 0x13000000 /* MCLK = SRC / 3 */ 1637 #define MCLK_DIV5 0x12000000 /* MCLK = SRC / 5 */ 1638 #define SCLK_DIV 0x00f00000 /* SCLK = MCLK / DIV */ 1639 #define SCLK_DIV1 0x00800000 1640 #define SCLK_DIV3 0x00900000 1641 #define SCLK_MASTER 0x00080000 /* Master mode */ 1642 #define SCLK_SLAVE 0x00000000 /* Slave mode */ 1643 #define SERIAL_FORMAT 0x00070000 1644 #define SERIAL_SONY 0x00000000 1645 #define SERIAL_64x 0x00010000 1646 #define SERIAL_32x 0x00020000 1647 #define SERIAL_DAV 0x00040000 1648 #define SERIAL_SILICON 0x00050000 1649 1650 /* 1651 * rate = fs = LRCLK 1652 * SCLK = 64*LRCLK (I2S) 1653 * MCLK = 256fs (typ. -- changeable) 1654 * 1655 * MCLK = clksrc / mdiv 1656 * SCLK = MCLK / sdiv 1657 * rate = SCLK / 64 ( = LRCLK = fs) 1658 */ 1659 1660 int 1661 snapper_set_rate(struct snapper_softc *sc) 1662 { 1663 u_int reg = 0, x; 1664 u_int rate = sc->sc_rate; 1665 uint32_t wordsize, ows; 1666 int MCLK; 1667 int clksrc, mdiv, sdiv; 1668 int mclk_fs; 1669 int timo; 1670 uint8_t mcr1; 1671 1672 switch (rate) { 1673 case 44100: 1674 clksrc = 45158400; /* 45MHz */ 1675 reg = CLKSRC_45MHz; 1676 mclk_fs = 256; 1677 break; 1678 1679 case 32000: 1680 case 48000: 1681 case 96000: 1682 clksrc = 49152000; /* 49MHz */ 1683 reg = CLKSRC_49MHz; 1684 mclk_fs = 256; 1685 break; 1686 1687 default: 1688 DPRINTF("snapper_set_rate: invalid rate %u\n", rate); 1689 return EINVAL; 1690 } 1691 1692 MCLK = rate * mclk_fs; 1693 mdiv = clksrc / MCLK; /* 4 */ 1694 sdiv = mclk_fs / 64; /* 4 */ 1695 1696 switch (mdiv) { 1697 case 1: 1698 reg |= MCLK_DIV1; 1699 break; 1700 case 3: 1701 reg |= MCLK_DIV3; 1702 break; 1703 case 5: 1704 reg |= MCLK_DIV5; 1705 break; 1706 default: 1707 reg |= ((mdiv / 2 - 1) << 24) & 0x1f000000; 1708 break; 1709 } 1710 1711 switch (sdiv) { 1712 case 1: 1713 reg |= SCLK_DIV1; 1714 break; 1715 case 3: 1716 reg |= SCLK_DIV3; 1717 break; 1718 default: 1719 reg |= ((sdiv / 2 - 1) << 20) & 0x00f00000; 1720 break; 1721 } 1722 1723 reg |= SCLK_MASTER; /* XXX master mode */ 1724 1725 reg |= SERIAL_64x; 1726 1727 /* stereo input and output */ 1728 1729 DPRINTF("precision: %d\n", sc->sc_bitspersample); 1730 switch(sc->sc_bitspersample) { 1731 case 16: 1732 wordsize = 0x02000200; 1733 mcr1 = DEQ_MCR1_SC_64 | DEQ_MCR1_SM_I2S | DEQ_MCR1_W_16; 1734 break; 1735 case 24: 1736 wordsize = 0x03000300; 1737 mcr1 = DEQ_MCR1_SC_64 | DEQ_MCR1_SM_I2S | DEQ_MCR1_W_24; 1738 break; 1739 default: 1740 printf("%s: unsupported sample size %d\n", 1741 device_xname(sc->sc_dev), sc->sc_bitspersample); 1742 return EINVAL; 1743 } 1744 1745 if (sc->sc_mode == SNAPPER_IS_TAS3001) 1746 mcr1 |= DEQ_MCR1_ISM_I2S; 1747 1748 ows = bus_space_read_4(sc->sc_tag, sc->sc_bsh, I2S_WORDSIZE); 1749 1750 DPRINTF("I2SSetDataWordSizeReg 0x%08x -> 0x%08x\n", 1751 ows, wordsize); 1752 if (ows != wordsize) { 1753 bus_space_write_4(sc->sc_tag, sc->sc_bsh, I2S_WORDSIZE, 1754 wordsize); 1755 if (sc->sc_mode != SNAPPER_SWVOL) 1756 tas3004_write(sc, DEQ_MCR1, &mcr1); 1757 } 1758 1759 x = bus_space_read_4(sc->sc_tag, sc->sc_bsh, I2S_FORMAT); 1760 if (x == reg) 1761 return 0; /* No change; do nothing. */ 1762 1763 DPRINTF("I2SSetSerialFormatReg 0x%x -> 0x%x\n", 1764 bus_space_read_4(sc->sc_tag, sc->sc_bsh, + I2S_FORMAT), reg); 1765 1766 /* Clear CLKSTOPPEND. */ 1767 bus_space_write_4(sc->sc_tag, sc->sc_bsh, I2S_INT, I2S_INT_CLKSTOPPEND); 1768 1769 x = obio_read_4(KEYLARGO_FCR1); /* FCR */ 1770 x &= ~I2S0CLKEN; /* XXX I2S0 */ 1771 obio_write_4(KEYLARGO_FCR1, x); 1772 1773 /* Wait until clock is stopped. */ 1774 for (timo = 1000; timo > 0; timo--) { 1775 if (bus_space_read_4(sc->sc_tag, sc->sc_bsh, I2S_INT) & 1776 I2S_INT_CLKSTOPPEND) 1777 goto done; 1778 delay(1); 1779 } 1780 DPRINTF("snapper_set_rate: timeout\n"); 1781 done: 1782 bus_space_write_4(sc->sc_tag, sc->sc_bsh, I2S_FORMAT, reg); 1783 1784 x = obio_read_4(KEYLARGO_FCR1); 1785 x |= I2S0CLKEN; 1786 obio_write_4(KEYLARGO_FCR1, x); 1787 1788 return 0; 1789 } 1790 1791 const struct tas3004_reg tas3004_initdata = { 1792 { DEQ_MCR1_SC_64 | DEQ_MCR1_SM_I2S | DEQ_MCR1_W_16 }, /* MCR1 */ 1793 { 1, 0, 0, 0, 0, 0 }, /* DRC */ 1794 { 0, 0, 0, 0, 0, 0 }, /* VOLUME */ 1795 { 0x72 }, /* TREBLE */ 1796 { 0x72 }, /* BASS */ 1797 { 0x10, 0x00, 0x00, 0, 0, 0, 0, 0, 0 }, /* MIXER_L */ 1798 { 0x10, 0x00, 0x00, 0, 0, 0, 0, 0, 0 }, /* MIXER_R */ 1799 { 0x10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, /* BIQUAD */ 1800 { 0x10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, /* BIQUAD */ 1801 { 0x10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, /* BIQUAD */ 1802 { 0x10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, /* BIQUAD */ 1803 { 0x10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, /* BIQUAD */ 1804 { 0x10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, /* BIQUAD */ 1805 { 0x10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, /* BIQUAD */ 1806 { 0x10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, /* BIQUAD */ 1807 { 0x10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, /* BIQUAD */ 1808 { 0x10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, /* BIQUAD */ 1809 { 0x10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, /* BIQUAD */ 1810 { 0x10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, /* BIQUAD */ 1811 { 0x10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, /* BIQUAD */ 1812 { 0x10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, /* BIQUAD */ 1813 { 0x10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, /* BIQUAD */ 1814 { 0x10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, /* BIQUAD */ 1815 { 0, 0, 0 }, /* LLB_GAIN */ 1816 { 0, 0, 0 }, /* RLB_GAIN */ 1817 { DEQ_ACR_ADM | DEQ_ACR_LRB | DEQ_ACR_INP_B }, /* ACR - right channel of input B is the microphone */ 1818 { 2 } /* MCR2 - AllPass mode since we don't use the equalizer anyway */ 1819 }; 1820 1821 const char tas3004_regsize[] = { 1822 0, /* 0x00 */ 1823 sizeof tas3004_initdata.MCR1, /* 0x01 */ 1824 sizeof tas3004_initdata.DRC, /* 0x02 */ 1825 0, /* 0x03 */ 1826 sizeof tas3004_initdata.VOLUME, /* 0x04 */ 1827 sizeof tas3004_initdata.TREBLE, /* 0x05 */ 1828 sizeof tas3004_initdata.BASS, /* 0x06 */ 1829 sizeof tas3004_initdata.MIXER_L, /* 0x07 */ 1830 sizeof tas3004_initdata.MIXER_R, /* 0x08 */ 1831 0, /* 0x09 */ 1832 sizeof tas3004_initdata.LB0, /* 0x0a */ 1833 sizeof tas3004_initdata.LB1, /* 0x0b */ 1834 sizeof tas3004_initdata.LB2, /* 0x0c */ 1835 sizeof tas3004_initdata.LB3, /* 0x0d */ 1836 sizeof tas3004_initdata.LB4, /* 0x0e */ 1837 sizeof tas3004_initdata.LB5, /* 0x0f */ 1838 sizeof tas3004_initdata.LB6, /* 0x10 */ 1839 0, /* 0x11 */ 1840 0, /* 0x12 */ 1841 sizeof tas3004_initdata.RB0, /* 0x13 */ 1842 sizeof tas3004_initdata.RB1, /* 0x14 */ 1843 sizeof tas3004_initdata.RB2, /* 0x15 */ 1844 sizeof tas3004_initdata.RB3, /* 0x16 */ 1845 sizeof tas3004_initdata.RB4, /* 0x17 */ 1846 sizeof tas3004_initdata.RB5, /* 0x18 */ 1847 sizeof tas3004_initdata.RB6, /* 0x19 */ 1848 0,0,0,0, 0,0, 1849 0, /* 0x20 */ 1850 sizeof tas3004_initdata.LLB, /* 0x21 */ 1851 sizeof tas3004_initdata.RLB, /* 0x22 */ 1852 sizeof tas3004_initdata.LLB_GAIN, /* 0x23 */ 1853 sizeof tas3004_initdata.RLB_GAIN, /* 0x24 */ 1854 0,0,0,0, 0,0,0,0, 0,0,0, 1855 0,0,0,0, 0,0,0,0, 0,0,0,0, 0,0,0,0, 1856 sizeof tas3004_initdata.ACR, /* 0x40 */ 1857 0, /* 0x41 */ 1858 0, /* 0x42 */ 1859 sizeof tas3004_initdata.MCR2 /* 0x43 */ 1860 }; 1861 1862 static int 1863 tas3004_write(struct snapper_softc *sc, u_int reg, const void *data) 1864 { 1865 int size; 1866 static char regblock[sizeof(struct tas3004_reg)+1]; 1867 1868 if (sc->sc_i2c == NULL) 1869 return 0; 1870 1871 KASSERT(reg < sizeof tas3004_regsize); 1872 size = tas3004_regsize[reg]; 1873 KASSERT(size > 0); 1874 1875 DPRINTF("reg: %x, %d %d\n", reg, size, ((const char*)data)[0]); 1876 1877 regblock[0] = reg; 1878 memcpy(®block[1], data, size); 1879 if (sc->sc_mode == SNAPPER_IS_TAS3001) { 1880 if (reg == DEQ_MIXER_L || reg == DEQ_MIXER_R) 1881 size = 3; 1882 else if (reg == DEQ_DRC || reg == DEQ_ACR || 1883 reg == DEQ_MCR2) { 1884 /* these registers are not available on TAS3001 */ 1885 return 0; 1886 } 1887 } 1888 iic_acquire_bus(sc->sc_i2c, 0); 1889 iic_exec(sc->sc_i2c, I2C_OP_WRITE, sc->sc_deqaddr, regblock, size + 1, 1890 NULL, 0, 0); 1891 iic_release_bus(sc->sc_i2c, 0); 1892 1893 return 0; 1894 } 1895 1896 static int 1897 gpio_read(char *addr) 1898 { 1899 1900 if (*addr & GPIO_DATA) 1901 return 1; 1902 return 0; 1903 } 1904 1905 static void 1906 gpio_write(char *addr, int val) 1907 { 1908 u_int data; 1909 1910 data = GPIO_DDR_OUTPUT; 1911 if (val) 1912 data |= GPIO_DATA; 1913 *addr = data; 1914 __asm volatile ("eieio"); 1915 } 1916 1917 #define headphone_active 0 /* XXX OF */ 1918 #define amp_active 0 /* XXX OF */ 1919 1920 static void 1921 snapper_mute_speaker(struct snapper_softc *sc, int mute) 1922 { 1923 u_int x; 1924 1925 if (amp_mute) { 1926 DPRINTF("ampmute %d --> ", gpio_read(amp_mute)); 1927 1928 if (mute) 1929 x = amp_active; /* mute */ 1930 else 1931 x = !amp_active; /* unmute */ 1932 if (x != gpio_read(amp_mute)) 1933 gpio_write(amp_mute, x); 1934 1935 DPRINTF("%d\n", gpio_read(amp_mute)); 1936 } 1937 } 1938 1939 static void 1940 snapper_mute_headphone(struct snapper_softc *sc, int mute) 1941 { 1942 u_int x; 1943 1944 if (headphone_mute != NULL) { 1945 DPRINTF("headphonemute %d --> ", gpio_read(headphone_mute)); 1946 1947 if (mute) 1948 x = headphone_active; /* mute */ 1949 else 1950 x = !headphone_active; /* unmute */ 1951 if (x != gpio_read(headphone_mute)) 1952 gpio_write(headphone_mute, x); 1953 1954 DPRINTF("%d\n", gpio_read(headphone_mute)); 1955 } 1956 } 1957 1958 static int 1959 snapper_cint(void *v) 1960 { 1961 struct snapper_softc *sc; 1962 u_int sense; 1963 1964 if (headphone_detect != NULL) { 1965 sc = v; 1966 sense = *headphone_detect; 1967 DPRINTF("headphone detect = 0x%x\n", sense); 1968 1969 if (((sense & 0x02) >> 1) == headphone_detect_active) { 1970 DPRINTF("headphone is inserted\n"); 1971 snapper_mute_speaker(sc, 1); 1972 snapper_mute_headphone(sc, 0); 1973 sc->sc_output_mask = 1 << 1; 1974 } else { 1975 DPRINTF("headphone is NOT inserted\n"); 1976 snapper_mute_speaker(sc, 0); 1977 snapper_mute_headphone(sc, 1); 1978 sc->sc_output_mask = 1 << 0; 1979 } 1980 } 1981 1982 return 1; 1983 } 1984 1985 #define reset_active 0 /* XXX OF */ 1986 1987 #define DEQ_WRITE(sc, reg, addr) \ 1988 if (tas3004_write(sc, reg, addr)) goto err 1989 1990 static int 1991 tas3004_init(struct snapper_softc *sc) 1992 { 1993 1994 /* No reset port. Nothing to do. */ 1995 if (audio_hw_reset == NULL) 1996 goto noreset; 1997 1998 /* Reset TAS3004. */ 1999 gpio_write(audio_hw_reset, !reset_active); /* Negate RESET */ 2000 delay(100000); /* XXX Really needed? */ 2001 2002 gpio_write(audio_hw_reset, reset_active); /* Assert RESET */ 2003 delay(1); 2004 2005 gpio_write(audio_hw_reset, !reset_active); /* Negate RESET */ 2006 delay(10000); 2007 2008 noreset: 2009 DEQ_WRITE(sc, DEQ_LB0, tas3004_initdata.LB0); 2010 DEQ_WRITE(sc, DEQ_LB1, tas3004_initdata.LB1); 2011 DEQ_WRITE(sc, DEQ_LB2, tas3004_initdata.LB2); 2012 DEQ_WRITE(sc, DEQ_LB3, tas3004_initdata.LB3); 2013 DEQ_WRITE(sc, DEQ_LB4, tas3004_initdata.LB4); 2014 DEQ_WRITE(sc, DEQ_LB5, tas3004_initdata.LB5); 2015 DEQ_WRITE(sc, DEQ_LB6, tas3004_initdata.LB6); 2016 DEQ_WRITE(sc, DEQ_RB0, tas3004_initdata.RB0); 2017 DEQ_WRITE(sc, DEQ_RB1, tas3004_initdata.RB1); 2018 DEQ_WRITE(sc, DEQ_RB1, tas3004_initdata.RB1); 2019 DEQ_WRITE(sc, DEQ_RB2, tas3004_initdata.RB2); 2020 DEQ_WRITE(sc, DEQ_RB3, tas3004_initdata.RB3); 2021 DEQ_WRITE(sc, DEQ_RB4, tas3004_initdata.RB4); 2022 DEQ_WRITE(sc, DEQ_RB5, tas3004_initdata.RB5); 2023 DEQ_WRITE(sc, DEQ_MCR1, tas3004_initdata.MCR1); 2024 DEQ_WRITE(sc, DEQ_MCR2, tas3004_initdata.MCR2); 2025 DEQ_WRITE(sc, DEQ_DRC, tas3004_initdata.DRC); 2026 DEQ_WRITE(sc, DEQ_VOLUME, tas3004_initdata.VOLUME); 2027 DEQ_WRITE(sc, DEQ_TREBLE, tas3004_initdata.TREBLE); 2028 DEQ_WRITE(sc, DEQ_BASS, tas3004_initdata.BASS); 2029 DEQ_WRITE(sc, DEQ_MIXER_L, tas3004_initdata.MIXER_L); 2030 DEQ_WRITE(sc, DEQ_MIXER_R, tas3004_initdata.MIXER_R); 2031 DEQ_WRITE(sc, DEQ_LLB, tas3004_initdata.LLB); 2032 DEQ_WRITE(sc, DEQ_RLB, tas3004_initdata.RLB); 2033 DEQ_WRITE(sc, DEQ_LLB_GAIN, tas3004_initdata.LLB_GAIN); 2034 DEQ_WRITE(sc, DEQ_RLB_GAIN, tas3004_initdata.RLB_GAIN); 2035 DEQ_WRITE(sc, DEQ_ACR, tas3004_initdata.ACR); 2036 2037 return 0; 2038 err: 2039 printf("tas3004_init: error\n"); 2040 return -1; 2041 } 2042 2043 static void 2044 snapper_init(struct snapper_softc *sc, int node) 2045 { 2046 int gpio; 2047 int headphone_detect_intr; 2048 uint32_t gpio_base, reg[1]; 2049 #ifdef SNAPPER_DEBUG 2050 char fcr[32]; 2051 2052 snprintb(fcr, sizeof(fcr), FCR3C_BITMASK, obio_read_4(KEYLARGO_FCR1)); 2053 printf("FCR(0x3c) %s\n", fcr); 2054 #endif 2055 headphone_detect_intr = -1; 2056 2057 gpio = of_getnode_byname(OF_parent(node), "gpio"); 2058 if (OF_getprop(gpio, "reg", reg, sizeof(reg)) == sizeof(reg)) 2059 gpio_base = reg[0]; 2060 else 2061 gpio_base = 0; 2062 DPRINTF(" /gpio 0x%x@0x%x\n", (unsigned)gpio, gpio_base); 2063 2064 gpio = OF_child(gpio); 2065 while (gpio) { 2066 char name[64], audio_gpio[64]; 2067 int intr[2]; 2068 char *addr; 2069 2070 memset(name, 0, sizeof name); 2071 memset(audio_gpio, 0, sizeof audio_gpio); 2072 addr = 0; 2073 OF_getprop(gpio, "name", name, sizeof name); 2074 OF_getprop(gpio, "audio-gpio", audio_gpio, sizeof audio_gpio); 2075 if (OF_getprop(gpio, "AAPL,address", &addr, sizeof addr) == -1) 2076 if (OF_getprop(gpio, "reg", reg, sizeof reg) 2077 == sizeof reg) 2078 addr = (char *)sc->sc_baseaddr + 2079 gpio_base + reg[0]; 2080 DPRINTF(" 0x%x %s %s\n", gpio, name, audio_gpio); 2081 2082 /* gpio5 */ 2083 if (strcmp(audio_gpio, "headphone-mute") == 0 || 2084 strcmp(name, "headphone-mute") == 0) 2085 headphone_mute = addr; 2086 /* gpio6 */ 2087 if (strcmp(audio_gpio, "amp-mute") == 0 || 2088 strcmp(name, "amp-mute") == 0) 2089 amp_mute = addr; 2090 /* extint-gpio15 */ 2091 if (strcmp(audio_gpio, "headphone-detect") == 0 || 2092 strcmp(name, "headphone-detect") == 0) { 2093 headphone_detect = addr; 2094 OF_getprop(gpio, "audio-gpio-active-state", 2095 &headphone_detect_active, 4); 2096 if (OF_getprop(gpio, "interrupts", intr, 8) == 8) { 2097 headphone_detect_intr = intr[0]; 2098 } 2099 } 2100 /* gpio11 (keywest-11) */ 2101 if (strcmp(audio_gpio, "audio-hw-reset") == 0 || 2102 strcmp(name, "hw-reset") == 0) 2103 audio_hw_reset = addr; 2104 2105 gpio = OF_peer(gpio); 2106 } 2107 2108 DPRINTF(" headphone-mute %p\n", headphone_mute); 2109 DPRINTF(" amp-mute %p\n", amp_mute); 2110 DPRINTF(" headphone-detect %p\n", headphone_detect); 2111 DPRINTF(" headphone-detect active %x\n", headphone_detect_active); 2112 DPRINTF(" headphone-detect intr %x\n", headphone_detect_intr); 2113 DPRINTF(" audio-hw-reset %p\n", audio_hw_reset); 2114 2115 if (headphone_detect_intr != -1) 2116 intr_establish(headphone_detect_intr, IST_EDGE, IPL_AUDIO, 2117 snapper_cint, sc); 2118 2119 sc->sc_rate = 44100; /* default rate */ 2120 sc->sc_bitspersample = 16; 2121 2122 /* Enable headphone interrupt? */ 2123 if (headphone_detect != NULL) { 2124 *headphone_detect |= 0x80; 2125 __asm volatile ("eieio"); 2126 } 2127 2128 if (tas3004_init(sc)) 2129 return; 2130 2131 /* Update headphone status. */ 2132 snapper_cint(sc); 2133 2134 snapper_set_volume(sc, 128, 128); 2135 snapper_set_bass(sc, 128); 2136 snapper_set_treble(sc, 128); 2137 2138 /* Record source defaults to microphone. This reflects the 2139 * default value for the ACR (see tas3004_initdata). 2140 */ 2141 sc->sc_record_source = 1 << 0; 2142 2143 /* We mute the analog input for now */ 2144 sc->mixer[0] = 128; 2145 sc->mixer[1] = 128; 2146 sc->mixer[2] = 0; 2147 sc->mixer[3] = 128; 2148 sc->mixer[4] = 128; 2149 sc->mixer[5] = 0; 2150 snapper_write_mixers(sc); 2151 } 2152
Indexes created Fri Sep 26 08:10:20 GMT 2025