1 /* 2 * This program is free software; you can redistribute it and/or modify 3 * it under the terms of the GNU General Public License as published by 4 * the Free Software Foundation; either version 2 of the License, or 5 * (at your option) any later version. 6 * 7 * This program is distributed in the hope that it will be useful, 8 * but WITHOUT ANY WARRANTY; without even the implied warranty of 9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 10 * GNU Library General Public License for more details. 11 * 12 * You should have received a copy of the GNU General Public License 13 * along with this program; if not, write to the Free Software 14 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. 15 */ 16 17 /* 18 Vortex core low level functions. 19 20 Author: Manuel Jander (mjander@users.sourceforge.cl) 21 These functions are mainly the result of translations made 22 from the original disassembly of the au88x0 binary drivers, 23 written by Aureal before they went down. 24 Many thanks to the Jeff Muizelaar, Kester Maddock, and whoever 25 contributed to the OpenVortex project. 26 The author of this file, put the few available pieces together 27 and translated the rest of the riddle (Mix, Src and connection stuff). 28 Some things are still to be discovered, and their meanings are unclear. 29 30 Some of these functions aren't intended to be really used, rather 31 to help to understand how does the AU88X0 chips work. Keep them in, because 32 they could be used somewhere in the future. 33 34 This code hasn't been tested or proof read thoroughly. If you wanna help, 35 take a look at the AU88X0 assembly and check if this matches. 36 Functions tested ok so far are (they show the desired effect 37 at least): 38 vortex_routes(); (1 bug fixed). 39 vortex_adb_addroute(); 40 vortex_adb_addroutes(); 41 vortex_connect_codecplay(); 42 vortex_src_flushbuffers(); 43 vortex_adbdma_setmode(); note: still some unknown arguments! 44 vortex_adbdma_startfifo(); 45 vortex_adbdma_stopfifo(); 46 vortex_fifo_setadbctrl(); note: still some unknown arguments! 47 vortex_mix_setinputvolumebyte(); 48 vortex_mix_enableinput(); 49 vortex_mixer_addWTD(); (fixed) 50 vortex_connection_adbdma_src_src(); 51 vortex_connection_adbdma_src(); 52 vortex_src_change_convratio(); 53 vortex_src_addWTD(); (fixed) 54 55 History: 56 57 01-03-2003 First revision. 58 01-21-2003 Some bug fixes. 59 17-02-2003 many bugfixes after a big versioning mess. 60 18-02-2003 JAAAAAHHHUUUUUU!!!! The mixer works !! I'm just so happy ! 61 (2 hours later...) I cant believe it! Im really lucky today. 62 Now the SRC is working too! Yeah! XMMS works ! 63 20-02-2003 First steps into the ALSA world. 64 28-02-2003 As my birthday present, i discovered how the DMA buffer pages really 65 work :-). It was all wrong. 66 12-03-2003 ALSA driver starts working (2 channels). 67 16-03-2003 More srcblock_setupchannel discoveries. 68 12-04-2003 AU8830 playback support. Recording in the works. 69 17-04-2003 vortex_route() and vortex_routes() bug fixes. AU8830 recording 70 works now, but chipn' dale effect is still there. 71 16-05-2003 SrcSetupChannel cleanup. Moved the Src setup stuff entirely 72 into au88x0_pcm.c . 73 06-06-2003 Buffer shifter bugfix. Mixer volume fix. 74 07-12-2003 A3D routing finally fixed. Believed to be OK. 75 25-03-2004 Many thanks to Claudia, for such valuable bug reports. 76 77 */ 78 79 #include "au88x0.h" 80 #include "au88x0_a3d.h" 81 #include <linux/delay.h> 82 83 /* MIXER (CAsp4Mix.s and CAsp4Mixer.s) */ 84 85 // FIXME: get rid of this. 86 static int mchannels[NR_MIXIN]; 87 static int rampchs[NR_MIXIN]; 88 89 static void vortex_mixer_en_sr(vortex_t * vortex, int channel) 90 { 91 hwwrite(vortex->mmio, VORTEX_MIXER_SR, 92 hwread(vortex->mmio, VORTEX_MIXER_SR) | (0x1 << channel)); 93 } 94 static void vortex_mixer_dis_sr(vortex_t * vortex, int channel) 95 { 96 hwwrite(vortex->mmio, VORTEX_MIXER_SR, 97 hwread(vortex->mmio, VORTEX_MIXER_SR) & ~(0x1 << channel)); 98 } 99 100 #if 0 101 static void 102 vortex_mix_muteinputgain(vortex_t * vortex, unsigned char mix, 103 unsigned char channel) 104 { 105 hwwrite(vortex->mmio, VORTEX_MIX_INVOL_A + ((mix << 5) + channel), 106 0x80); 107 hwwrite(vortex->mmio, VORTEX_MIX_INVOL_B + ((mix << 5) + channel), 108 0x80); 109 } 110 111 static int vortex_mix_getvolume(vortex_t * vortex, unsigned char mix) 112 { 113 int a; 114 a = hwread(vortex->mmio, VORTEX_MIX_VOL_A + (mix << 2)) & 0xff; 115 //FP2LinearFrac(a); 116 return (a); 117 } 118 119 static int 120 vortex_mix_getinputvolume(vortex_t * vortex, unsigned char mix, 121 int channel, int *vol) 122 { 123 int a; 124 if (!(mchannels[mix] & (1 << channel))) 125 return 0; 126 a = hwread(vortex->mmio, 127 VORTEX_MIX_INVOL_A + (((mix << 5) + channel) << 2)); 128 /* 129 if (rampchs[mix] == 0) 130 a = FP2LinearFrac(a); 131 else 132 a = FP2LinearFracWT(a); 133 */ 134 *vol = a; 135 return (0); 136 } 137 138 static unsigned int vortex_mix_boost6db(unsigned char vol) 139 { 140 return (vol + 8); /* WOW! what a complex function! */ 141 } 142 143 static void vortex_mix_rampvolume(vortex_t * vortex, int mix) 144 { 145 int ch; 146 char a; 147 // This function is intended for ramping down only (see vortex_disableinput()). 148 for (ch = 0; ch < 0x20; ch++) { 149 if (((1 << ch) & rampchs[mix]) == 0) 150 continue; 151 a = hwread(vortex->mmio, 152 VORTEX_MIX_INVOL_B + (((mix << 5) + ch) << 2)); 153 if (a > -126) { 154 a -= 2; 155 hwwrite(vortex->mmio, 156 VORTEX_MIX_INVOL_A + 157 (((mix << 5) + ch) << 2), a); 158 hwwrite(vortex->mmio, 159 VORTEX_MIX_INVOL_B + 160 (((mix << 5) + ch) << 2), a); 161 } else 162 vortex_mix_killinput(vortex, mix, ch); 163 } 164 } 165 166 static int 167 vortex_mix_getenablebit(vortex_t * vortex, unsigned char mix, int mixin) 168 { 169 int addr, temp; 170 if (mixin >= 0) 171 addr = mixin; 172 else 173 addr = mixin + 3; 174 addr = ((mix << 3) + (addr >> 2)) << 2; 175 temp = hwread(vortex->mmio, VORTEX_MIX_ENIN + addr); 176 return ((temp >> (mixin & 3)) & 1); 177 } 178 #endif 179 static void 180 vortex_mix_setvolumebyte(vortex_t * vortex, unsigned char mix, 181 unsigned char vol) 182 { 183 int temp; 184 hwwrite(vortex->mmio, VORTEX_MIX_VOL_A + (mix << 2), vol); 185 if (1) { /*if (this_10) */ 186 temp = hwread(vortex->mmio, VORTEX_MIX_VOL_B + (mix << 2)); 187 if ((temp != 0x80) || (vol == 0x80)) 188 return; 189 } 190 hwwrite(vortex->mmio, VORTEX_MIX_VOL_B + (mix << 2), vol); 191 } 192 193 static void 194 vortex_mix_setinputvolumebyte(vortex_t * vortex, unsigned char mix, 195 int mixin, unsigned char vol) 196 { 197 int temp; 198 199 hwwrite(vortex->mmio, 200 VORTEX_MIX_INVOL_A + (((mix << 5) + mixin) << 2), vol); 201 if (1) { /* this_10, initialized to 1. */ 202 temp = 203 hwread(vortex->mmio, 204 VORTEX_MIX_INVOL_B + (((mix << 5) + mixin) << 2)); 205 if ((temp != 0x80) || (vol == 0x80)) 206 return; 207 } 208 hwwrite(vortex->mmio, 209 VORTEX_MIX_INVOL_B + (((mix << 5) + mixin) << 2), vol); 210 } 211 212 static void 213 vortex_mix_setenablebit(vortex_t * vortex, unsigned char mix, int mixin, int en) 214 { 215 int temp, addr; 216 217 if (mixin < 0) 218 addr = (mixin + 3); 219 else 220 addr = mixin; 221 addr = ((mix << 3) + (addr >> 2)) << 2; 222 temp = hwread(vortex->mmio, VORTEX_MIX_ENIN + addr); 223 if (en) 224 temp |= (1 << (mixin & 3)); 225 else 226 temp &= ~(1 << (mixin & 3)); 227 /* Mute input. Astatic void crackling? */ 228 hwwrite(vortex->mmio, 229 VORTEX_MIX_INVOL_B + (((mix << 5) + mixin) << 2), 0x80); 230 /* Looks like clear buffer. */ 231 hwwrite(vortex->mmio, VORTEX_MIX_SMP + (mixin << 2), 0x0); 232 hwwrite(vortex->mmio, VORTEX_MIX_SMP + 4 + (mixin << 2), 0x0); 233 /* Write enable bit. */ 234 hwwrite(vortex->mmio, VORTEX_MIX_ENIN + addr, temp); 235 } 236 237 static void 238 vortex_mix_killinput(vortex_t * vortex, unsigned char mix, int mixin) 239 { 240 rampchs[mix] &= ~(1 << mixin); 241 vortex_mix_setinputvolumebyte(vortex, mix, mixin, 0x80); 242 mchannels[mix] &= ~(1 << mixin); 243 vortex_mix_setenablebit(vortex, mix, mixin, 0); 244 } 245 246 static void 247 vortex_mix_enableinput(vortex_t * vortex, unsigned char mix, int mixin) 248 { 249 vortex_mix_killinput(vortex, mix, mixin); 250 if ((mchannels[mix] & (1 << mixin)) == 0) { 251 vortex_mix_setinputvolumebyte(vortex, mix, mixin, 0x80); /*0x80 : mute */ 252 mchannels[mix] |= (1 << mixin); 253 } 254 vortex_mix_setenablebit(vortex, mix, mixin, 1); 255 } 256 257 static void 258 vortex_mix_disableinput(vortex_t * vortex, unsigned char mix, int channel, 259 int ramp) 260 { 261 if (ramp) { 262 rampchs[mix] |= (1 << channel); 263 // Register callback. 264 //vortex_mix_startrampvolume(vortex); 265 vortex_mix_killinput(vortex, mix, channel); 266 } else 267 vortex_mix_killinput(vortex, mix, channel); 268 } 269 270 static int 271 vortex_mixer_addWTD(vortex_t * vortex, unsigned char mix, unsigned char ch) 272 { 273 int temp, lifeboat = 0, prev; 274 275 temp = hwread(vortex->mmio, VORTEX_MIXER_SR); 276 if ((temp & (1 << ch)) == 0) { 277 hwwrite(vortex->mmio, VORTEX_MIXER_CHNBASE + (ch << 2), mix); 278 vortex_mixer_en_sr(vortex, ch); 279 return 1; 280 } 281 prev = VORTEX_MIXER_CHNBASE + (ch << 2); 282 temp = hwread(vortex->mmio, prev); 283 while (temp & 0x10) { 284 prev = VORTEX_MIXER_RTBASE + ((temp & 0xf) << 2); 285 temp = hwread(vortex->mmio, prev); 286 //printk(KERN_INFO "vortex: mixAddWTD: while addr=%x, val=%x\n", prev, temp); 287 if ((++lifeboat) > 0xf) { 288 printk(KERN_ERR 289 "vortex_mixer_addWTD: lifeboat overflow\n"); 290 return 0; 291 } 292 } 293 hwwrite(vortex->mmio, VORTEX_MIXER_RTBASE + ((temp & 0xf) << 2), mix); 294 hwwrite(vortex->mmio, prev, (temp & 0xf) | 0x10); 295 return 1; 296 } 297 298 static int 299 vortex_mixer_delWTD(vortex_t * vortex, unsigned char mix, unsigned char ch) 300 { 301 int esp14 = -1, esp18, eax, ebx, edx, ebp, esi = 0; 302 //int esp1f=edi(while)=src, esp10=ch; 303 304 eax = hwread(vortex->mmio, VORTEX_MIXER_SR); 305 if (((1 << ch) & eax) == 0) { 306 printk(KERN_ERR "mix ALARM %x\n", eax); 307 return 0; 308 } 309 ebp = VORTEX_MIXER_CHNBASE + (ch << 2); 310 esp18 = hwread(vortex->mmio, ebp); 311 if (esp18 & 0x10) { 312 ebx = (esp18 & 0xf); 313 if (mix == ebx) { 314 ebx = VORTEX_MIXER_RTBASE + (mix << 2); 315 edx = hwread(vortex->mmio, ebx); 316 //7b60 317 hwwrite(vortex->mmio, ebp, edx); 318 hwwrite(vortex->mmio, ebx, 0); 319 } else { 320 //7ad3 321 edx = 322 hwread(vortex->mmio, 323 VORTEX_MIXER_RTBASE + (ebx << 2)); 324 //printk(KERN_INFO "vortex: mixdelWTD: 1 addr=%x, val=%x, src=%x\n", ebx, edx, src); 325 while ((edx & 0xf) != mix) { 326 if ((esi) > 0xf) { 327 printk(KERN_ERR 328 "vortex: mixdelWTD: error lifeboat overflow\n"); 329 return 0; 330 } 331 esp14 = ebx; 332 ebx = edx & 0xf; 333 ebp = ebx << 2; 334 edx = 335 hwread(vortex->mmio, 336 VORTEX_MIXER_RTBASE + ebp); 337 //printk(KERN_INFO "vortex: mixdelWTD: while addr=%x, val=%x\n", ebp, edx); 338 esi++; 339 } 340 //7b30 341 ebp = ebx << 2; 342 if (edx & 0x10) { /* Delete entry in between others */ 343 ebx = VORTEX_MIXER_RTBASE + ((edx & 0xf) << 2); 344 edx = hwread(vortex->mmio, ebx); 345 //7b60 346 hwwrite(vortex->mmio, 347 VORTEX_MIXER_RTBASE + ebp, edx); 348 hwwrite(vortex->mmio, ebx, 0); 349 //printk(KERN_INFO "vortex mixdelWTD between addr= 0x%x, val= 0x%x\n", ebp, edx); 350 } else { /* Delete last entry */ 351 //7b83 352 if (esp14 == -1) 353 hwwrite(vortex->mmio, 354 VORTEX_MIXER_CHNBASE + 355 (ch << 2), esp18 & 0xef); 356 else { 357 ebx = (0xffffffe0 & edx) | (0xf & ebx); 358 hwwrite(vortex->mmio, 359 VORTEX_MIXER_RTBASE + 360 (esp14 << 2), ebx); 361 //printk(KERN_INFO "vortex mixdelWTD last addr= 0x%x, val= 0x%x\n", esp14, ebx); 362 } 363 hwwrite(vortex->mmio, 364 VORTEX_MIXER_RTBASE + ebp, 0); 365 return 1; 366 } 367 } 368 } else { 369 //printk(KERN_INFO "removed last mix\n"); 370 //7be0 371 vortex_mixer_dis_sr(vortex, ch); 372 hwwrite(vortex->mmio, ebp, 0); 373 } 374 return 1; 375 } 376 377 static void vortex_mixer_init(vortex_t * vortex) 378 { 379 u32 addr; 380 int x; 381 382 // FIXME: get rid of this crap. 383 memset(mchannels, 0, NR_MIXOUT * sizeof(int)); 384 memset(rampchs, 0, NR_MIXOUT * sizeof(int)); 385 386 addr = VORTEX_MIX_SMP + 0x17c; 387 for (x = 0x5f; x >= 0; x--) { 388 hwwrite(vortex->mmio, addr, 0); 389 addr -= 4; 390 } 391 addr = VORTEX_MIX_ENIN + 0x1fc; 392 for (x = 0x7f; x >= 0; x--) { 393 hwwrite(vortex->mmio, addr, 0); 394 addr -= 4; 395 } 396 addr = VORTEX_MIX_SMP + 0x17c; 397 for (x = 0x5f; x >= 0; x--) { 398 hwwrite(vortex->mmio, addr, 0); 399 addr -= 4; 400 } 401 addr = VORTEX_MIX_INVOL_A + 0x7fc; 402 for (x = 0x1ff; x >= 0; x--) { 403 hwwrite(vortex->mmio, addr, 0x80); 404 addr -= 4; 405 } 406 addr = VORTEX_MIX_VOL_A + 0x3c; 407 for (x = 0xf; x >= 0; x--) { 408 hwwrite(vortex->mmio, addr, 0x80); 409 addr -= 4; 410 } 411 addr = VORTEX_MIX_INVOL_B + 0x7fc; 412 for (x = 0x1ff; x >= 0; x--) { 413 hwwrite(vortex->mmio, addr, 0x80); 414 addr -= 4; 415 } 416 addr = VORTEX_MIX_VOL_B + 0x3c; 417 for (x = 0xf; x >= 0; x--) { 418 hwwrite(vortex->mmio, addr, 0x80); 419 addr -= 4; 420 } 421 addr = VORTEX_MIXER_RTBASE + (MIXER_RTBASE_SIZE - 1) * 4; 422 for (x = (MIXER_RTBASE_SIZE - 1); x >= 0; x--) { 423 hwwrite(vortex->mmio, addr, 0x0); 424 addr -= 4; 425 } 426 hwwrite(vortex->mmio, VORTEX_MIXER_SR, 0); 427 428 /* Set clipping ceiling (this may be all wrong). */ 429 /* 430 for (x = 0; x < 0x80; x++) { 431 hwwrite(vortex->mmio, VORTEX_MIXER_CLIP + (x << 2), 0x3ffff); 432 } 433 */ 434 /* 435 call CAsp4Mix__Initialize_CAsp4HwIO____CAsp4Mixer____ 436 Register ISR callback for volume smooth fade out. 437 Maybe this avoids clicks when press "stop" ? 438 */ 439 } 440 441 /* SRC (CAsp4Src.s and CAsp4SrcBlock) */ 442 443 static void vortex_src_en_sr(vortex_t * vortex, int channel) 444 { 445 hwwrite(vortex->mmio, VORTEX_SRCBLOCK_SR, 446 hwread(vortex->mmio, VORTEX_SRCBLOCK_SR) | (0x1 << channel)); 447 } 448 449 static void vortex_src_dis_sr(vortex_t * vortex, int channel) 450 { 451 hwwrite(vortex->mmio, VORTEX_SRCBLOCK_SR, 452 hwread(vortex->mmio, VORTEX_SRCBLOCK_SR) & ~(0x1 << channel)); 453 } 454 455 static void vortex_src_flushbuffers(vortex_t * vortex, unsigned char src) 456 { 457 int i; 458 459 for (i = 0x1f; i >= 0; i--) 460 hwwrite(vortex->mmio, 461 VORTEX_SRC_DATA0 + (src << 7) + (i << 2), 0); 462 hwwrite(vortex->mmio, VORTEX_SRC_DATA + (src << 3), 0); 463 hwwrite(vortex->mmio, VORTEX_SRC_DATA + (src << 3) + 4, 0); 464 } 465 466 static void vortex_src_cleardrift(vortex_t * vortex, unsigned char src) 467 { 468 hwwrite(vortex->mmio, VORTEX_SRC_DRIFT0 + (src << 2), 0); 469 hwwrite(vortex->mmio, VORTEX_SRC_DRIFT1 + (src << 2), 0); 470 hwwrite(vortex->mmio, VORTEX_SRC_DRIFT2 + (src << 2), 1); 471 } 472 473 static void 474 vortex_src_set_throttlesource(vortex_t * vortex, unsigned char src, int en) 475 { 476 int temp; 477 478 temp = hwread(vortex->mmio, VORTEX_SRC_SOURCE); 479 if (en) 480 temp |= 1 << src; 481 else 482 temp &= ~(1 << src); 483 hwwrite(vortex->mmio, VORTEX_SRC_SOURCE, temp); 484 } 485 486 static int 487 vortex_src_persist_convratio(vortex_t * vortex, unsigned char src, int ratio) 488 { 489 int temp, lifeboat = 0; 490 491 do { 492 hwwrite(vortex->mmio, VORTEX_SRC_CONVRATIO + (src << 2), ratio); 493 temp = hwread(vortex->mmio, VORTEX_SRC_CONVRATIO + (src << 2)); 494 if ((++lifeboat) > 0x9) { 495 printk(KERN_ERR "Vortex: Src cvr fail\n"); 496 break; 497 } 498 } 499 while (temp != ratio); 500 return temp; 501 } 502 503 #if 0 504 static void vortex_src_slowlock(vortex_t * vortex, unsigned char src) 505 { 506 int temp; 507 508 hwwrite(vortex->mmio, VORTEX_SRC_DRIFT2 + (src << 2), 1); 509 hwwrite(vortex->mmio, VORTEX_SRC_DRIFT0 + (src << 2), 0); 510 temp = hwread(vortex->mmio, VORTEX_SRC_U0 + (src << 2)); 511 if (temp & 0x200) 512 hwwrite(vortex->mmio, VORTEX_SRC_U0 + (src << 2), 513 temp & ~0x200L); 514 } 515 516 static void 517 vortex_src_change_convratio(vortex_t * vortex, unsigned char src, int ratio) 518 { 519 int temp, a; 520 521 if ((ratio & 0x10000) && (ratio != 0x10000)) { 522 if (ratio & 0x3fff) 523 a = (0x11 - ((ratio >> 0xe) & 0x3)) - 1; 524 else 525 a = (0x11 - ((ratio >> 0xe) & 0x3)) - 2; 526 } else 527 a = 0xc; 528 temp = hwread(vortex->mmio, VORTEX_SRC_U0 + (src << 2)); 529 if (((temp >> 4) & 0xf) != a) 530 hwwrite(vortex->mmio, VORTEX_SRC_U0 + (src << 2), 531 (temp & 0xf) | ((a & 0xf) << 4)); 532 533 vortex_src_persist_convratio(vortex, src, ratio); 534 } 535 536 static int 537 vortex_src_checkratio(vortex_t * vortex, unsigned char src, 538 unsigned int desired_ratio) 539 { 540 int hw_ratio, lifeboat = 0; 541 542 hw_ratio = hwread(vortex->mmio, VORTEX_SRC_CONVRATIO + (src << 2)); 543 544 while (hw_ratio != desired_ratio) { 545 hwwrite(vortex->mmio, VORTEX_SRC_CONVRATIO + (src << 2), desired_ratio); 546 547 if ((lifeboat++) > 15) { 548 printk(KERN_ERR "Vortex: could not set src-%d from %d to %d\n", 549 src, hw_ratio, desired_ratio); 550 break; 551 } 552 } 553 554 return hw_ratio; 555 } 556 557 #endif 558 /* 559 Objective: Set samplerate for given SRC module. 560 Arguments: 561 card: pointer to vortex_t strcut. 562 src: Integer index of the SRC module. 563 cr: Current sample rate conversion factor. 564 b: unknown 16 bit value. 565 sweep: Enable Samplerate fade from cr toward tr flag. 566 dirplay: 1: playback, 0: recording. 567 sl: Slow Lock flag. 568 tr: Target samplerate conversion. 569 thsource: Throttle source flag (no idea what that means). 570 */ 571 static void vortex_src_setupchannel(vortex_t * card, unsigned char src, 572 unsigned int cr, unsigned int b, int sweep, int d, 573 int dirplay, int sl, unsigned int tr, int thsource) 574 { 575 // noplayback: d=2,4,7,0xa,0xb when using first 2 src's. 576 // c: enables pitch sweep. 577 // looks like g is c related. Maybe g is a sweep parameter ? 578 // g = cvr 579 // dirplay: 0 = recording, 1 = playback 580 // d = src hw index. 581 582 int esi, ebp = 0, esp10; 583 584 vortex_src_flushbuffers(card, src); 585 586 if (sweep) { 587 if ((tr & 0x10000) && (tr != 0x10000)) { 588 tr = 0; 589 esi = 0x7; 590 } else { 591 if ((((short)tr) < 0) && (tr != 0x8000)) { 592 tr = 0; 593 esi = 0x8; 594 } else { 595 tr = 1; 596 esi = 0xc; 597 } 598 } 599 } else { 600 if ((cr & 0x10000) && (cr != 0x10000)) { 601 tr = 0; /*ebx = 0 */ 602 esi = 0x11 - ((cr >> 0xe) & 7); 603 if (cr & 0x3fff) 604 esi -= 1; 605 else 606 esi -= 2; 607 } else { 608 tr = 1; 609 esi = 0xc; 610 } 611 } 612 vortex_src_cleardrift(card, src); 613 vortex_src_set_throttlesource(card, src, thsource); 614 615 if ((dirplay == 0) && (sweep == 0)) { 616 if (tr) 617 esp10 = 0xf; 618 else 619 esp10 = 0xc; 620 ebp = 0; 621 } else { 622 if (tr) 623 ebp = 0xf; 624 else 625 ebp = 0xc; 626 esp10 = 0; 627 } 628 hwwrite(card->mmio, VORTEX_SRC_U0 + (src << 2), 629 (sl << 0x9) | (sweep << 0x8) | ((esi & 0xf) << 4) | d); 630 /* 0xc0 esi=0xc c=f=0 d=0 */ 631 vortex_src_persist_convratio(card, src, cr); 632 hwwrite(card->mmio, VORTEX_SRC_U1 + (src << 2), b & 0xffff); 633 /* 0 b=0 */ 634 hwwrite(card->mmio, VORTEX_SRC_U2 + (src << 2), 635 (tr << 0x11) | (dirplay << 0x10) | (ebp << 0x8) | esp10); 636 /* 0x30f00 e=g=1 esp10=0 ebp=f */ 637 //printk(KERN_INFO "vortex: SRC %d, d=0x%x, esi=0x%x, esp10=0x%x, ebp=0x%x\n", src, d, esi, esp10, ebp); 638 } 639 640 static void vortex_srcblock_init(vortex_t * vortex) 641 { 642 u32 addr; 643 int x; 644 hwwrite(vortex->mmio, VORTEX_SRC_SOURCESIZE, 0x1ff); 645 /* 646 for (x=0; x<0x10; x++) { 647 vortex_src_init(&vortex_src[x], x); 648 } 649 */ 650 //addr = 0xcc3c; 651 //addr = 0x26c3c; 652 addr = VORTEX_SRC_RTBASE + 0x3c; 653 for (x = 0xf; x >= 0; x--) { 654 hwwrite(vortex->mmio, addr, 0); 655 addr -= 4; 656 } 657 //addr = 0xcc94; 658 //addr = 0x26c94; 659 addr = VORTEX_SRC_CHNBASE + 0x54; 660 for (x = 0x15; x >= 0; x--) { 661 hwwrite(vortex->mmio, addr, 0); 662 addr -= 4; 663 } 664 } 665 666 static int 667 vortex_src_addWTD(vortex_t * vortex, unsigned char src, unsigned char ch) 668 { 669 int temp, lifeboat = 0, prev; 670 // esp13 = src 671 672 temp = hwread(vortex->mmio, VORTEX_SRCBLOCK_SR); 673 if ((temp & (1 << ch)) == 0) { 674 hwwrite(vortex->mmio, VORTEX_SRC_CHNBASE + (ch << 2), src); 675 vortex_src_en_sr(vortex, ch); 676 return 1; 677 } 678 prev = VORTEX_SRC_CHNBASE + (ch << 2); /*ebp */ 679 temp = hwread(vortex->mmio, prev); 680 //while (temp & NR_SRC) { 681 while (temp & 0x10) { 682 prev = VORTEX_SRC_RTBASE + ((temp & 0xf) << 2); /*esp12 */ 683 //prev = VORTEX_SRC_RTBASE + ((temp & (NR_SRC-1)) << 2); /*esp12*/ 684 temp = hwread(vortex->mmio, prev); 685 //printk(KERN_INFO "vortex: srcAddWTD: while addr=%x, val=%x\n", prev, temp); 686 if ((++lifeboat) > 0xf) { 687 printk(KERN_ERR 688 "vortex_src_addWTD: lifeboat overflow\n"); 689 return 0; 690 } 691 } 692 hwwrite(vortex->mmio, VORTEX_SRC_RTBASE + ((temp & 0xf) << 2), src); 693 //hwwrite(vortex->mmio, prev, (temp & (NR_SRC-1)) | NR_SRC); 694 hwwrite(vortex->mmio, prev, (temp & 0xf) | 0x10); 695 return 1; 696 } 697 698 static int 699 vortex_src_delWTD(vortex_t * vortex, unsigned char src, unsigned char ch) 700 { 701 int esp14 = -1, esp18, eax, ebx, edx, ebp, esi = 0; 702 //int esp1f=edi(while)=src, esp10=ch; 703 704 eax = hwread(vortex->mmio, VORTEX_SRCBLOCK_SR); 705 if (((1 << ch) & eax) == 0) { 706 printk(KERN_ERR "src alarm\n"); 707 return 0; 708 } 709 ebp = VORTEX_SRC_CHNBASE + (ch << 2); 710 esp18 = hwread(vortex->mmio, ebp); 711 if (esp18 & 0x10) { 712 ebx = (esp18 & 0xf); 713 if (src == ebx) { 714 ebx = VORTEX_SRC_RTBASE + (src << 2); 715 edx = hwread(vortex->mmio, ebx); 716 //7b60 717 hwwrite(vortex->mmio, ebp, edx); 718 hwwrite(vortex->mmio, ebx, 0); 719 } else { 720 //7ad3 721 edx = 722 hwread(vortex->mmio, 723 VORTEX_SRC_RTBASE + (ebx << 2)); 724 //printk(KERN_INFO "vortex: srcdelWTD: 1 addr=%x, val=%x, src=%x\n", ebx, edx, src); 725 while ((edx & 0xf) != src) { 726 if ((esi) > 0xf) { 727 printk 728 ("vortex: srcdelWTD: error, lifeboat overflow\n"); 729 return 0; 730 } 731 esp14 = ebx; 732 ebx = edx & 0xf; 733 ebp = ebx << 2; 734 edx = 735 hwread(vortex->mmio, 736 VORTEX_SRC_RTBASE + ebp); 737 //printk(KERN_INFO "vortex: srcdelWTD: while addr=%x, val=%x\n", ebp, edx); 738 esi++; 739 } 740 //7b30 741 ebp = ebx << 2; 742 if (edx & 0x10) { /* Delete entry in between others */ 743 ebx = VORTEX_SRC_RTBASE + ((edx & 0xf) << 2); 744 edx = hwread(vortex->mmio, ebx); 745 //7b60 746 hwwrite(vortex->mmio, 747 VORTEX_SRC_RTBASE + ebp, edx); 748 hwwrite(vortex->mmio, ebx, 0); 749 //printk(KERN_INFO "vortex srcdelWTD between addr= 0x%x, val= 0x%x\n", ebp, edx); 750 } else { /* Delete last entry */ 751 //7b83 752 if (esp14 == -1) 753 hwwrite(vortex->mmio, 754 VORTEX_SRC_CHNBASE + 755 (ch << 2), esp18 & 0xef); 756 else { 757 ebx = (0xffffffe0 & edx) | (0xf & ebx); 758 hwwrite(vortex->mmio, 759 VORTEX_SRC_RTBASE + 760 (esp14 << 2), ebx); 761 //printk(KERN_INFO"vortex srcdelWTD last addr= 0x%x, val= 0x%x\n", esp14, ebx); 762 } 763 hwwrite(vortex->mmio, 764 VORTEX_SRC_RTBASE + ebp, 0); 765 return 1; 766 } 767 } 768 } else { 769 //7be0 770 vortex_src_dis_sr(vortex, ch); 771 hwwrite(vortex->mmio, ebp, 0); 772 } 773 return 1; 774 } 775 776 /*FIFO*/ 777 778 static void 779 vortex_fifo_clearadbdata(vortex_t * vortex, int fifo, int x) 780 { 781 for (x--; x >= 0; x--) 782 hwwrite(vortex->mmio, 783 VORTEX_FIFO_ADBDATA + 784 (((fifo << FIFO_SIZE_BITS) + x) << 2), 0); 785 } 786 787 #if 0 788 static void vortex_fifo_adbinitialize(vortex_t * vortex, int fifo, int j) 789 { 790 vortex_fifo_clearadbdata(vortex, fifo, FIFO_SIZE); 791 #ifdef CHIP_AU8820 792 hwwrite(vortex->mmio, VORTEX_FIFO_ADBCTRL + (fifo << 2), 793 (FIFO_U1 | ((j & FIFO_MASK) << 0xb))); 794 #else 795 hwwrite(vortex->mmio, VORTEX_FIFO_ADBCTRL + (fifo << 2), 796 (FIFO_U1 | ((j & FIFO_MASK) << 0xc))); 797 #endif 798 } 799 #endif 800 static void vortex_fifo_setadbvalid(vortex_t * vortex, int fifo, int en) 801 { 802 hwwrite(vortex->mmio, VORTEX_FIFO_ADBCTRL + (fifo << 2), 803 (hwread(vortex->mmio, VORTEX_FIFO_ADBCTRL + (fifo << 2)) & 804 0xffffffef) | ((1 & en) << 4) | FIFO_U1); 805 } 806 807 static void 808 vortex_fifo_setadbctrl(vortex_t * vortex, int fifo, int stereo, int priority, 809 int empty, int valid, int f) 810 { 811 int temp, lifeboat = 0; 812 //int this_8[NR_ADB] = {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0}; /* position */ 813 int this_4 = 0x2; 814 /* f seems priority related. 815 * CAsp4AdbDma::SetPriority is the only place that calls SetAdbCtrl with f set to 1 816 * every where else it is set to 0. It seems, however, that CAsp4AdbDma::SetPriority 817 * is never called, thus the f related bits remain a mystery for now. 818 */ 819 do { 820 temp = hwread(vortex->mmio, VORTEX_FIFO_ADBCTRL + (fifo << 2)); 821 if (lifeboat++ > 0xbb8) { 822 printk(KERN_ERR 823 "Vortex: vortex_fifo_setadbctrl fail\n"); 824 break; 825 } 826 } 827 while (temp & FIFO_RDONLY); 828 829 // AU8830 semes to take some special care about fifo content (data). 830 // But i'm just to lazy to translate that :) 831 if (valid) { 832 if ((temp & FIFO_VALID) == 0) { 833 //this_8[fifo] = 0; 834 vortex_fifo_clearadbdata(vortex, fifo, FIFO_SIZE); // this_4 835 #ifdef CHIP_AU8820 836 temp = (this_4 & 0x1f) << 0xb; 837 #else 838 temp = (this_4 & 0x3f) << 0xc; 839 #endif 840 temp = (temp & 0xfffffffd) | ((stereo & 1) << 1); 841 temp = (temp & 0xfffffff3) | ((priority & 3) << 2); 842 temp = (temp & 0xffffffef) | ((valid & 1) << 4); 843 temp |= FIFO_U1; 844 temp = (temp & 0xffffffdf) | ((empty & 1) << 5); 845 #ifdef CHIP_AU8820 846 temp = (temp & 0xfffbffff) | ((f & 1) << 0x12); 847 #endif 848 #ifdef CHIP_AU8830 849 temp = (temp & 0xf7ffffff) | ((f & 1) << 0x1b); 850 temp = (temp & 0xefffffff) | ((f & 1) << 0x1c); 851 #endif 852 #ifdef CHIP_AU8810 853 temp = (temp & 0xfeffffff) | ((f & 1) << 0x18); 854 temp = (temp & 0xfdffffff) | ((f & 1) << 0x19); 855 #endif 856 } 857 } else { 858 if (temp & FIFO_VALID) { 859 #ifdef CHIP_AU8820 860 temp = ((f & 1) << 0x12) | (temp & 0xfffbffef); 861 #endif 862 #ifdef CHIP_AU8830 863 temp = 864 ((f & 1) << 0x1b) | (temp & 0xe7ffffef) | FIFO_BITS; 865 #endif 866 #ifdef CHIP_AU8810 867 temp = 868 ((f & 1) << 0x18) | (temp & 0xfcffffef) | FIFO_BITS; 869 #endif 870 } else 871 /*if (this_8[fifo]) */ 872 vortex_fifo_clearadbdata(vortex, fifo, FIFO_SIZE); 873 } 874 hwwrite(vortex->mmio, VORTEX_FIFO_ADBCTRL + (fifo << 2), temp); 875 hwread(vortex->mmio, VORTEX_FIFO_ADBCTRL + (fifo << 2)); 876 } 877 878 #ifndef CHIP_AU8810 879 static void vortex_fifo_clearwtdata(vortex_t * vortex, int fifo, int x) 880 { 881 if (x < 1) 882 return; 883 for (x--; x >= 0; x--) 884 hwwrite(vortex->mmio, 885 VORTEX_FIFO_WTDATA + 886 (((fifo << FIFO_SIZE_BITS) + x) << 2), 0); 887 } 888 889 static void vortex_fifo_wtinitialize(vortex_t * vortex, int fifo, int j) 890 { 891 vortex_fifo_clearwtdata(vortex, fifo, FIFO_SIZE); 892 #ifdef CHIP_AU8820 893 hwwrite(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2), 894 (FIFO_U1 | ((j & FIFO_MASK) << 0xb))); 895 #else 896 hwwrite(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2), 897 (FIFO_U1 | ((j & FIFO_MASK) << 0xc))); 898 #endif 899 } 900 901 static void vortex_fifo_setwtvalid(vortex_t * vortex, int fifo, int en) 902 { 903 hwwrite(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2), 904 (hwread(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2)) & 905 0xffffffef) | ((en & 1) << 4) | FIFO_U1); 906 } 907 908 static void 909 vortex_fifo_setwtctrl(vortex_t * vortex, int fifo, int ctrl, int priority, 910 int empty, int valid, int f) 911 { 912 int temp = 0, lifeboat = 0; 913 int this_4 = 2; 914 915 do { 916 temp = hwread(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2)); 917 if (lifeboat++ > 0xbb8) { 918 printk(KERN_ERR "Vortex: vortex_fifo_setwtctrl fail\n"); 919 break; 920 } 921 } 922 while (temp & FIFO_RDONLY); 923 924 if (valid) { 925 if ((temp & FIFO_VALID) == 0) { 926 vortex_fifo_clearwtdata(vortex, fifo, FIFO_SIZE); // this_4 927 #ifdef CHIP_AU8820 928 temp = (this_4 & 0x1f) << 0xb; 929 #else 930 temp = (this_4 & 0x3f) << 0xc; 931 #endif 932 temp = (temp & 0xfffffffd) | ((ctrl & 1) << 1); 933 temp = (temp & 0xfffffff3) | ((priority & 3) << 2); 934 temp = (temp & 0xffffffef) | ((valid & 1) << 4); 935 temp |= FIFO_U1; 936 temp = (temp & 0xffffffdf) | ((empty & 1) << 5); 937 #ifdef CHIP_AU8820 938 temp = (temp & 0xfffbffff) | ((f & 1) << 0x12); 939 #endif 940 #ifdef CHIP_AU8830 941 temp = (temp & 0xf7ffffff) | ((f & 1) << 0x1b); 942 temp = (temp & 0xefffffff) | ((f & 1) << 0x1c); 943 #endif 944 #ifdef CHIP_AU8810 945 temp = (temp & 0xfeffffff) | ((f & 1) << 0x18); 946 temp = (temp & 0xfdffffff) | ((f & 1) << 0x19); 947 #endif 948 } 949 } else { 950 if (temp & FIFO_VALID) { 951 #ifdef CHIP_AU8820 952 temp = ((f & 1) << 0x12) | (temp & 0xfffbffef); 953 #endif 954 #ifdef CHIP_AU8830 955 temp = 956 ((f & 1) << 0x1b) | (temp & 0xe7ffffef) | FIFO_BITS; 957 #endif 958 #ifdef CHIP_AU8810 959 temp = 960 ((f & 1) << 0x18) | (temp & 0xfcffffef) | FIFO_BITS; 961 #endif 962 } else 963 /*if (this_8[fifo]) */ 964 vortex_fifo_clearwtdata(vortex, fifo, FIFO_SIZE); 965 } 966 hwwrite(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2), temp); 967 hwread(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2)); 968 969 /* 970 do { 971 temp = hwread(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2)); 972 if (lifeboat++ > 0xbb8) { 973 printk(KERN_ERR "Vortex: vortex_fifo_setwtctrl fail (hanging)\n"); 974 break; 975 } 976 } while ((temp & FIFO_RDONLY)&&(temp & FIFO_VALID)&&(temp != 0xFFFFFFFF)); 977 978 979 if (valid) { 980 if (temp & FIFO_VALID) { 981 temp = 0x40000; 982 //temp |= 0x08000000; 983 //temp |= 0x10000000; 984 //temp |= 0x04000000; 985 //temp |= 0x00400000; 986 temp |= 0x1c400000; 987 temp &= 0xFFFFFFF3; 988 temp &= 0xFFFFFFEF; 989 temp |= (valid & 1) << 4; 990 hwwrite(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2), temp); 991 return; 992 } else { 993 vortex_fifo_clearwtdata(vortex, fifo, FIFO_SIZE); 994 return; 995 } 996 } else { 997 temp &= 0xffffffef; 998 temp |= 0x08000000; 999 temp |= 0x10000000; 1000 temp |= 0x04000000; 1001 temp |= 0x00400000; 1002 hwwrite(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2), temp); 1003 temp = hwread(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2)); 1004 //((temp >> 6) & 0x3f) 1005 1006 priority = 0; 1007 if (((temp & 0x0fc0) ^ ((temp >> 6) & 0x0fc0)) & 0FFFFFFC0) 1008 vortex_fifo_clearwtdata(vortex, fifo, FIFO_SIZE); 1009 valid = 0xfb; 1010 temp = (temp & 0xfffffffd) | ((ctrl & 1) << 1); 1011 temp = (temp & 0xfffdffff) | ((f & 1) << 0x11); 1012 temp = (temp & 0xfffffff3) | ((priority & 3) << 2); 1013 temp = (temp & 0xffffffef) | ((valid & 1) << 4); 1014 temp = (temp & 0xffffffdf) | ((empty & 1) << 5); 1015 hwwrite(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2), temp); 1016 } 1017 1018 */ 1019 1020 /* 1021 temp = (temp & 0xfffffffd) | ((ctrl & 1) << 1); 1022 temp = (temp & 0xfffdffff) | ((f & 1) << 0x11); 1023 temp = (temp & 0xfffffff3) | ((priority & 3) << 2); 1024 temp = (temp & 0xffffffef) | ((valid & 1) << 4); 1025 temp = (temp & 0xffffffdf) | ((empty & 1) << 5); 1026 #ifdef FIFO_BITS 1027 temp = temp | FIFO_BITS | 40000; 1028 #endif 1029 // 0x1c440010, 0x1c400000 1030 hwwrite(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2), temp); 1031 */ 1032 } 1033 1034 #endif 1035 static void vortex_fifo_init(vortex_t * vortex) 1036 { 1037 int x; 1038 u32 addr; 1039 1040 /* ADB DMA channels fifos. */ 1041 addr = VORTEX_FIFO_ADBCTRL + ((NR_ADB - 1) * 4); 1042 for (x = NR_ADB - 1; x >= 0; x--) { 1043 hwwrite(vortex->mmio, addr, (FIFO_U0 | FIFO_U1)); 1044 if (hwread(vortex->mmio, addr) != (FIFO_U0 | FIFO_U1)) 1045 printk(KERN_ERR "bad adb fifo reset!"); 1046 vortex_fifo_clearadbdata(vortex, x, FIFO_SIZE); 1047 addr -= 4; 1048 } 1049 1050 #ifndef CHIP_AU8810 1051 /* WT DMA channels fifos. */ 1052 addr = VORTEX_FIFO_WTCTRL + ((NR_WT - 1) * 4); 1053 for (x = NR_WT - 1; x >= 0; x--) { 1054 hwwrite(vortex->mmio, addr, FIFO_U0); 1055 if (hwread(vortex->mmio, addr) != FIFO_U0) 1056 printk(KERN_ERR 1057 "bad wt fifo reset (0x%08x, 0x%08x)!\n", 1058 addr, hwread(vortex->mmio, addr)); 1059 vortex_fifo_clearwtdata(vortex, x, FIFO_SIZE); 1060 addr -= 4; 1061 } 1062 #endif 1063 /* trigger... */ 1064 #ifdef CHIP_AU8820 1065 hwwrite(vortex->mmio, 0xf8c0, 0xd03); //0x0843 0xd6b 1066 #else 1067 #ifdef CHIP_AU8830 1068 hwwrite(vortex->mmio, 0x17000, 0x61); /* wt a */ 1069 hwwrite(vortex->mmio, 0x17004, 0x61); /* wt b */ 1070 #endif 1071 hwwrite(vortex->mmio, 0x17008, 0x61); /* adb */ 1072 #endif 1073 } 1074 1075 /* ADBDMA */ 1076 1077 static void vortex_adbdma_init(vortex_t * vortex) 1078 { 1079 } 1080 1081 static void vortex_adbdma_setfirstbuffer(vortex_t * vortex, int adbdma) 1082 { 1083 stream_t *dma = &vortex->dma_adb[adbdma]; 1084 1085 hwwrite(vortex->mmio, VORTEX_ADBDMA_CTRL + (adbdma << 2), 1086 dma->dma_ctrl); 1087 } 1088 1089 static void vortex_adbdma_setstartbuffer(vortex_t * vortex, int adbdma, int sb) 1090 { 1091 stream_t *dma = &vortex->dma_adb[adbdma]; 1092 //hwwrite(vortex->mmio, VORTEX_ADBDMA_START + (adbdma << 2), sb << (((NR_ADB-1)-((adbdma&0xf)*2)))); 1093 hwwrite(vortex->mmio, VORTEX_ADBDMA_START + (adbdma << 2), 1094 sb << ((0xf - (adbdma & 0xf)) * 2)); 1095 dma->period_real = dma->period_virt = sb; 1096 } 1097 1098 static void 1099 vortex_adbdma_setbuffers(vortex_t * vortex, int adbdma, 1100 int psize, int count) 1101 { 1102 stream_t *dma = &vortex->dma_adb[adbdma]; 1103 1104 dma->period_bytes = psize; 1105 dma->nr_periods = count; 1106 1107 dma->cfg0 = 0; 1108 dma->cfg1 = 0; 1109 switch (count) { 1110 /* Four or more pages */ 1111 default: 1112 case 4: 1113 dma->cfg1 |= 0x88000000 | 0x44000000 | 0x30000000 | (psize - 1); 1114 hwwrite(vortex->mmio, 1115 VORTEX_ADBDMA_BUFBASE + (adbdma << 4) + 0xc, 1116 snd_pcm_sgbuf_get_addr(dma->substream, psize * 3)); 1117 /* 3 pages */ 1118 case 3: 1119 dma->cfg0 |= 0x12000000; 1120 dma->cfg1 |= 0x80000000 | 0x40000000 | ((psize - 1) << 0xc); 1121 hwwrite(vortex->mmio, 1122 VORTEX_ADBDMA_BUFBASE + (adbdma << 4) + 0x8, 1123 snd_pcm_sgbuf_get_addr(dma->substream, psize * 2)); 1124 /* 2 pages */ 1125 case 2: 1126 dma->cfg0 |= 0x88000000 | 0x44000000 | 0x10000000 | (psize - 1); 1127 hwwrite(vortex->mmio, 1128 VORTEX_ADBDMA_BUFBASE + (adbdma << 4) + 0x4, 1129 snd_pcm_sgbuf_get_addr(dma->substream, psize)); 1130 /* 1 page */ 1131 case 1: 1132 dma->cfg0 |= 0x80000000 | 0x40000000 | ((psize - 1) << 0xc); 1133 hwwrite(vortex->mmio, 1134 VORTEX_ADBDMA_BUFBASE + (adbdma << 4), 1135 snd_pcm_sgbuf_get_addr(dma->substream, 0)); 1136 break; 1137 } 1138 /* 1139 printk(KERN_DEBUG "vortex: cfg0 = 0x%x\nvortex: cfg1=0x%x\n", 1140 dma->cfg0, dma->cfg1); 1141 */ 1142 hwwrite(vortex->mmio, VORTEX_ADBDMA_BUFCFG0 + (adbdma << 3), dma->cfg0); 1143 hwwrite(vortex->mmio, VORTEX_ADBDMA_BUFCFG1 + (adbdma << 3), dma->cfg1); 1144 1145 vortex_adbdma_setfirstbuffer(vortex, adbdma); 1146 vortex_adbdma_setstartbuffer(vortex, adbdma, 0); 1147 } 1148 1149 static void 1150 vortex_adbdma_setmode(vortex_t * vortex, int adbdma, int ie, int dir, 1151 int fmt, int stereo, u32 offset) 1152 { 1153 stream_t *dma = &vortex->dma_adb[adbdma]; 1154 1155 dma->dma_unknown = stereo; 1156 dma->dma_ctrl = 1157 ((offset & OFFSET_MASK) | (dma->dma_ctrl & ~OFFSET_MASK)); 1158 /* Enable PCMOUT interrupts. */ 1159 dma->dma_ctrl = 1160 (dma->dma_ctrl & ~IE_MASK) | ((ie << IE_SHIFT) & IE_MASK); 1161 1162 dma->dma_ctrl = 1163 (dma->dma_ctrl & ~DIR_MASK) | ((dir << DIR_SHIFT) & DIR_MASK); 1164 dma->dma_ctrl = 1165 (dma->dma_ctrl & ~FMT_MASK) | ((fmt << FMT_SHIFT) & FMT_MASK); 1166 1167 hwwrite(vortex->mmio, VORTEX_ADBDMA_CTRL + (adbdma << 2), 1168 dma->dma_ctrl); 1169 hwread(vortex->mmio, VORTEX_ADBDMA_CTRL + (adbdma << 2)); 1170 } 1171 1172 static int vortex_adbdma_bufshift(vortex_t * vortex, int adbdma) 1173 { 1174 stream_t *dma = &vortex->dma_adb[adbdma]; 1175 int page, p, pp, delta, i; 1176 1177 page = 1178 (hwread(vortex->mmio, VORTEX_ADBDMA_STAT + (adbdma << 2)) & 1179 ADB_SUBBUF_MASK) >> ADB_SUBBUF_SHIFT; 1180 if (dma->nr_periods >= 4) 1181 delta = (page - dma->period_real) & 3; 1182 else { 1183 delta = (page - dma->period_real); 1184 if (delta < 0) 1185 delta += dma->nr_periods; 1186 } 1187 if (delta == 0) 1188 return 0; 1189 1190 /* refresh hw page table */ 1191 if (dma->nr_periods > 4) { 1192 for (i = 0; i < delta; i++) { 1193 /* p: audio buffer page index */ 1194 p = dma->period_virt + i + 4; 1195 if (p >= dma->nr_periods) 1196 p -= dma->nr_periods; 1197 /* pp: hardware DMA page index. */ 1198 pp = dma->period_real + i; 1199 if (pp >= 4) 1200 pp -= 4; 1201 //hwwrite(vortex->mmio, VORTEX_ADBDMA_BUFBASE+(((adbdma << 2)+pp) << 2), dma->table[p].addr); 1202 hwwrite(vortex->mmio, 1203 VORTEX_ADBDMA_BUFBASE + (((adbdma << 2) + pp) << 2), 1204 snd_pcm_sgbuf_get_addr(dma->substream, 1205 dma->period_bytes * p)); 1206 /* Force write thru cache. */ 1207 hwread(vortex->mmio, VORTEX_ADBDMA_BUFBASE + 1208 (((adbdma << 2) + pp) << 2)); 1209 } 1210 } 1211 dma->period_virt += delta; 1212 dma->period_real = page; 1213 if (dma->period_virt >= dma->nr_periods) 1214 dma->period_virt -= dma->nr_periods; 1215 if (delta != 1) 1216 printk(KERN_INFO "vortex: %d virt=%d, real=%d, delta=%d\n", 1217 adbdma, dma->period_virt, dma->period_real, delta); 1218 1219 return delta; 1220 } 1221 1222 1223 static void vortex_adbdma_resetup(vortex_t *vortex, int adbdma) { 1224 stream_t *dma = &vortex->dma_adb[adbdma]; 1225 int p, pp, i; 1226 1227 /* refresh hw page table */ 1228 for (i=0 ; i < 4 && i < dma->nr_periods; i++) { 1229 /* p: audio buffer page index */ 1230 p = dma->period_virt + i; 1231 if (p >= dma->nr_periods) 1232 p -= dma->nr_periods; 1233 /* pp: hardware DMA page index. */ 1234 pp = dma->period_real + i; 1235 if (dma->nr_periods < 4) { 1236 if (pp >= dma->nr_periods) 1237 pp -= dma->nr_periods; 1238 } 1239 else { 1240 if (pp >= 4) 1241 pp -= 4; 1242 } 1243 hwwrite(vortex->mmio, 1244 VORTEX_ADBDMA_BUFBASE + (((adbdma << 2) + pp) << 2), 1245 snd_pcm_sgbuf_get_addr(dma->substream, 1246 dma->period_bytes * p)); 1247 /* Force write thru cache. */ 1248 hwread(vortex->mmio, VORTEX_ADBDMA_BUFBASE + (((adbdma << 2)+pp) << 2)); 1249 } 1250 } 1251 1252 static inline int vortex_adbdma_getlinearpos(vortex_t * vortex, int adbdma) 1253 { 1254 stream_t *dma = &vortex->dma_adb[adbdma]; 1255 int temp, page, delta; 1256 1257 temp = hwread(vortex->mmio, VORTEX_ADBDMA_STAT + (adbdma << 2)); 1258 page = (temp & ADB_SUBBUF_MASK) >> ADB_SUBBUF_SHIFT; 1259 if (dma->nr_periods >= 4) 1260 delta = (page - dma->period_real) & 3; 1261 else { 1262 delta = (page - dma->period_real); 1263 if (delta < 0) 1264 delta += dma->nr_periods; 1265 } 1266 return (dma->period_virt + delta) * dma->period_bytes 1267 + (temp & (dma->period_bytes - 1)); 1268 } 1269 1270 static void vortex_adbdma_startfifo(vortex_t * vortex, int adbdma) 1271 { 1272 int this_8 = 0 /*empty */ , this_4 = 0 /*priority */ ; 1273 stream_t *dma = &vortex->dma_adb[adbdma]; 1274 1275 switch (dma->fifo_status) { 1276 case FIFO_START: 1277 vortex_fifo_setadbvalid(vortex, adbdma, 1278 dma->fifo_enabled ? 1 : 0); 1279 break; 1280 case FIFO_STOP: 1281 this_8 = 1; 1282 hwwrite(vortex->mmio, VORTEX_ADBDMA_CTRL + (adbdma << 2), 1283 dma->dma_ctrl); 1284 vortex_fifo_setadbctrl(vortex, adbdma, dma->dma_unknown, 1285 this_4, this_8, 1286 dma->fifo_enabled ? 1 : 0, 0); 1287 break; 1288 case FIFO_PAUSE: 1289 vortex_fifo_setadbctrl(vortex, adbdma, dma->dma_unknown, 1290 this_4, this_8, 1291 dma->fifo_enabled ? 1 : 0, 0); 1292 break; 1293 } 1294 dma->fifo_status = FIFO_START; 1295 } 1296 1297 static void vortex_adbdma_resumefifo(vortex_t * vortex, int adbdma) 1298 { 1299 stream_t *dma = &vortex->dma_adb[adbdma]; 1300 1301 int this_8 = 1, this_4 = 0; 1302 switch (dma->fifo_status) { 1303 case FIFO_STOP: 1304 hwwrite(vortex->mmio, VORTEX_ADBDMA_CTRL + (adbdma << 2), 1305 dma->dma_ctrl); 1306 vortex_fifo_setadbctrl(vortex, adbdma, dma->dma_unknown, 1307 this_4, this_8, 1308 dma->fifo_enabled ? 1 : 0, 0); 1309 break; 1310 case FIFO_PAUSE: 1311 vortex_fifo_setadbctrl(vortex, adbdma, dma->dma_unknown, 1312 this_4, this_8, 1313 dma->fifo_enabled ? 1 : 0, 0); 1314 break; 1315 } 1316 dma->fifo_status = FIFO_START; 1317 } 1318 1319 static void vortex_adbdma_pausefifo(vortex_t * vortex, int adbdma) 1320 { 1321 stream_t *dma = &vortex->dma_adb[adbdma]; 1322 1323 int this_8 = 0, this_4 = 0; 1324 switch (dma->fifo_status) { 1325 case FIFO_START: 1326 vortex_fifo_setadbctrl(vortex, adbdma, dma->dma_unknown, 1327 this_4, this_8, 0, 0); 1328 break; 1329 case FIFO_STOP: 1330 hwwrite(vortex->mmio, VORTEX_ADBDMA_CTRL + (adbdma << 2), 1331 dma->dma_ctrl); 1332 vortex_fifo_setadbctrl(vortex, adbdma, dma->dma_unknown, 1333 this_4, this_8, 0, 0); 1334 break; 1335 } 1336 dma->fifo_status = FIFO_PAUSE; 1337 } 1338 1339 static void vortex_adbdma_stopfifo(vortex_t * vortex, int adbdma) 1340 { 1341 stream_t *dma = &vortex->dma_adb[adbdma]; 1342 1343 int this_4 = 0, this_8 = 0; 1344 if (dma->fifo_status == FIFO_START) 1345 vortex_fifo_setadbctrl(vortex, adbdma, dma->dma_unknown, 1346 this_4, this_8, 0, 0); 1347 else if (dma->fifo_status == FIFO_STOP) 1348 return; 1349 dma->fifo_status = FIFO_STOP; 1350 dma->fifo_enabled = 0; 1351 } 1352 1353 /* WTDMA */ 1354 1355 #ifndef CHIP_AU8810 1356 static void vortex_wtdma_setfirstbuffer(vortex_t * vortex, int wtdma) 1357 { 1358 //int this_7c=dma_ctrl; 1359 stream_t *dma = &vortex->dma_wt[wtdma]; 1360 1361 hwwrite(vortex->mmio, VORTEX_WTDMA_CTRL + (wtdma << 2), dma->dma_ctrl); 1362 } 1363 1364 static void vortex_wtdma_setstartbuffer(vortex_t * vortex, int wtdma, int sb) 1365 { 1366 stream_t *dma = &vortex->dma_wt[wtdma]; 1367 //hwwrite(vortex->mmio, VORTEX_WTDMA_START + (wtdma << 2), sb << ((0x1f-(wtdma&0xf)*2))); 1368 hwwrite(vortex->mmio, VORTEX_WTDMA_START + (wtdma << 2), 1369 sb << ((0xf - (wtdma & 0xf)) * 2)); 1370 dma->period_real = dma->period_virt = sb; 1371 } 1372 1373 static void 1374 vortex_wtdma_setbuffers(vortex_t * vortex, int wtdma, 1375 int psize, int count) 1376 { 1377 stream_t *dma = &vortex->dma_wt[wtdma]; 1378 1379 dma->period_bytes = psize; 1380 dma->nr_periods = count; 1381 1382 dma->cfg0 = 0; 1383 dma->cfg1 = 0; 1384 switch (count) { 1385 /* Four or more pages */ 1386 default: 1387 case 4: 1388 dma->cfg1 |= 0x88000000 | 0x44000000 | 0x30000000 | (psize-1); 1389 hwwrite(vortex->mmio, VORTEX_WTDMA_BUFBASE + (wtdma << 4) + 0xc, 1390 snd_pcm_sgbuf_get_addr(dma->substream, psize * 3)); 1391 /* 3 pages */ 1392 case 3: 1393 dma->cfg0 |= 0x12000000; 1394 dma->cfg1 |= 0x80000000 | 0x40000000 | ((psize-1) << 0xc); 1395 hwwrite(vortex->mmio, VORTEX_WTDMA_BUFBASE + (wtdma << 4) + 0x8, 1396 snd_pcm_sgbuf_get_addr(dma->substream, psize * 2)); 1397 /* 2 pages */ 1398 case 2: 1399 dma->cfg0 |= 0x88000000 | 0x44000000 | 0x10000000 | (psize-1); 1400 hwwrite(vortex->mmio, VORTEX_WTDMA_BUFBASE + (wtdma << 4) + 0x4, 1401 snd_pcm_sgbuf_get_addr(dma->substream, psize)); 1402 /* 1 page */ 1403 case 1: 1404 dma->cfg0 |= 0x80000000 | 0x40000000 | ((psize-1) << 0xc); 1405 hwwrite(vortex->mmio, VORTEX_WTDMA_BUFBASE + (wtdma << 4), 1406 snd_pcm_sgbuf_get_addr(dma->substream, 0)); 1407 break; 1408 } 1409 hwwrite(vortex->mmio, VORTEX_WTDMA_BUFCFG0 + (wtdma << 3), dma->cfg0); 1410 hwwrite(vortex->mmio, VORTEX_WTDMA_BUFCFG1 + (wtdma << 3), dma->cfg1); 1411 1412 vortex_wtdma_setfirstbuffer(vortex, wtdma); 1413 vortex_wtdma_setstartbuffer(vortex, wtdma, 0); 1414 } 1415 1416 static void 1417 vortex_wtdma_setmode(vortex_t * vortex, int wtdma, int ie, int fmt, int d, 1418 /*int e, */ u32 offset) 1419 { 1420 stream_t *dma = &vortex->dma_wt[wtdma]; 1421 1422 //dma->this_08 = e; 1423 dma->dma_unknown = d; 1424 dma->dma_ctrl = 0; 1425 dma->dma_ctrl = 1426 ((offset & OFFSET_MASK) | (dma->dma_ctrl & ~OFFSET_MASK)); 1427 /* PCMOUT interrupt */ 1428 dma->dma_ctrl = 1429 (dma->dma_ctrl & ~IE_MASK) | ((ie << IE_SHIFT) & IE_MASK); 1430 /* Always playback. */ 1431 dma->dma_ctrl |= (1 << DIR_SHIFT); 1432 /* Audio Format */ 1433 dma->dma_ctrl = 1434 (dma->dma_ctrl & FMT_MASK) | ((fmt << FMT_SHIFT) & FMT_MASK); 1435 /* Write into hardware */ 1436 hwwrite(vortex->mmio, VORTEX_WTDMA_CTRL + (wtdma << 2), dma->dma_ctrl); 1437 } 1438 1439 static int vortex_wtdma_bufshift(vortex_t * vortex, int wtdma) 1440 { 1441 stream_t *dma = &vortex->dma_wt[wtdma]; 1442 int page, p, pp, delta, i; 1443 1444 page = 1445 (hwread(vortex->mmio, VORTEX_WTDMA_STAT + (wtdma << 2)) & 1446 WT_SUBBUF_MASK) 1447 >> WT_SUBBUF_SHIFT; 1448 if (dma->nr_periods >= 4) 1449 delta = (page - dma->period_real) & 3; 1450 else { 1451 delta = (page - dma->period_real); 1452 if (delta < 0) 1453 delta += dma->nr_periods; 1454 } 1455 if (delta == 0) 1456 return 0; 1457 1458 /* refresh hw page table */ 1459 if (dma->nr_periods > 4) { 1460 for (i = 0; i < delta; i++) { 1461 /* p: audio buffer page index */ 1462 p = dma->period_virt + i + 4; 1463 if (p >= dma->nr_periods) 1464 p -= dma->nr_periods; 1465 /* pp: hardware DMA page index. */ 1466 pp = dma->period_real + i; 1467 if (pp >= 4) 1468 pp -= 4; 1469 hwwrite(vortex->mmio, 1470 VORTEX_WTDMA_BUFBASE + 1471 (((wtdma << 2) + pp) << 2), 1472 snd_pcm_sgbuf_get_addr(dma->substream, 1473 dma->period_bytes * p)); 1474 /* Force write thru cache. */ 1475 hwread(vortex->mmio, VORTEX_WTDMA_BUFBASE + 1476 (((wtdma << 2) + pp) << 2)); 1477 } 1478 } 1479 dma->period_virt += delta; 1480 if (dma->period_virt >= dma->nr_periods) 1481 dma->period_virt -= dma->nr_periods; 1482 dma->period_real = page; 1483 1484 if (delta != 1) 1485 printk(KERN_WARNING "vortex: wt virt = %d, delta = %d\n", 1486 dma->period_virt, delta); 1487 1488 return delta; 1489 } 1490 1491 #if 0 1492 static void 1493 vortex_wtdma_getposition(vortex_t * vortex, int wtdma, int *subbuf, int *pos) 1494 { 1495 int temp; 1496 temp = hwread(vortex->mmio, VORTEX_WTDMA_STAT + (wtdma << 2)); 1497 *subbuf = (temp >> WT_SUBBUF_SHIFT) & WT_SUBBUF_MASK; 1498 *pos = temp & POS_MASK; 1499 } 1500 1501 static int vortex_wtdma_getcursubuffer(vortex_t * vortex, int wtdma) 1502 { 1503 return ((hwread(vortex->mmio, VORTEX_WTDMA_STAT + (wtdma << 2)) >> 1504 POS_SHIFT) & POS_MASK); 1505 } 1506 #endif 1507 static inline int vortex_wtdma_getlinearpos(vortex_t * vortex, int wtdma) 1508 { 1509 stream_t *dma = &vortex->dma_wt[wtdma]; 1510 int temp; 1511 1512 temp = hwread(vortex->mmio, VORTEX_WTDMA_STAT + (wtdma << 2)); 1513 temp = (dma->period_virt * dma->period_bytes) + (temp & (dma->period_bytes - 1)); 1514 return temp; 1515 } 1516 1517 static void vortex_wtdma_startfifo(vortex_t * vortex, int wtdma) 1518 { 1519 stream_t *dma = &vortex->dma_wt[wtdma]; 1520 int this_8 = 0, this_4 = 0; 1521 1522 switch (dma->fifo_status) { 1523 case FIFO_START: 1524 vortex_fifo_setwtvalid(vortex, wtdma, 1525 dma->fifo_enabled ? 1 : 0); 1526 break; 1527 case FIFO_STOP: 1528 this_8 = 1; 1529 hwwrite(vortex->mmio, VORTEX_WTDMA_CTRL + (wtdma << 2), 1530 dma->dma_ctrl); 1531 vortex_fifo_setwtctrl(vortex, wtdma, dma->dma_unknown, 1532 this_4, this_8, 1533 dma->fifo_enabled ? 1 : 0, 0); 1534 break; 1535 case FIFO_PAUSE: 1536 vortex_fifo_setwtctrl(vortex, wtdma, dma->dma_unknown, 1537 this_4, this_8, 1538 dma->fifo_enabled ? 1 : 0, 0); 1539 break; 1540 } 1541 dma->fifo_status = FIFO_START; 1542 } 1543 1544 static void vortex_wtdma_resumefifo(vortex_t * vortex, int wtdma) 1545 { 1546 stream_t *dma = &vortex->dma_wt[wtdma]; 1547 1548 int this_8 = 0, this_4 = 0; 1549 switch (dma->fifo_status) { 1550 case FIFO_STOP: 1551 hwwrite(vortex->mmio, VORTEX_WTDMA_CTRL + (wtdma << 2), 1552 dma->dma_ctrl); 1553 vortex_fifo_setwtctrl(vortex, wtdma, dma->dma_unknown, 1554 this_4, this_8, 1555 dma->fifo_enabled ? 1 : 0, 0); 1556 break; 1557 case FIFO_PAUSE: 1558 vortex_fifo_setwtctrl(vortex, wtdma, dma->dma_unknown, 1559 this_4, this_8, 1560 dma->fifo_enabled ? 1 : 0, 0); 1561 break; 1562 } 1563 dma->fifo_status = FIFO_START; 1564 } 1565 1566 static void vortex_wtdma_pausefifo(vortex_t * vortex, int wtdma) 1567 { 1568 stream_t *dma = &vortex->dma_wt[wtdma]; 1569 1570 int this_8 = 0, this_4 = 0; 1571 switch (dma->fifo_status) { 1572 case FIFO_START: 1573 vortex_fifo_setwtctrl(vortex, wtdma, dma->dma_unknown, 1574 this_4, this_8, 0, 0); 1575 break; 1576 case FIFO_STOP: 1577 hwwrite(vortex->mmio, VORTEX_WTDMA_CTRL + (wtdma << 2), 1578 dma->dma_ctrl); 1579 vortex_fifo_setwtctrl(vortex, wtdma, dma->dma_unknown, 1580 this_4, this_8, 0, 0); 1581 break; 1582 } 1583 dma->fifo_status = FIFO_PAUSE; 1584 } 1585 1586 static void vortex_wtdma_stopfifo(vortex_t * vortex, int wtdma) 1587 { 1588 stream_t *dma = &vortex->dma_wt[wtdma]; 1589 1590 int this_4 = 0, this_8 = 0; 1591 if (dma->fifo_status == FIFO_START) 1592 vortex_fifo_setwtctrl(vortex, wtdma, dma->dma_unknown, 1593 this_4, this_8, 0, 0); 1594 else if (dma->fifo_status == FIFO_STOP) 1595 return; 1596 dma->fifo_status = FIFO_STOP; 1597 dma->fifo_enabled = 0; 1598 } 1599 1600 #endif 1601 /* ADB Routes */ 1602 1603 typedef int ADBRamLink; 1604 static void vortex_adb_init(vortex_t * vortex) 1605 { 1606 int i; 1607 /* it looks like we are writing more than we need to... 1608 * if we write what we are supposed to it breaks things... */ 1609 hwwrite(vortex->mmio, VORTEX_ADB_SR, 0); 1610 for (i = 0; i < VORTEX_ADB_RTBASE_COUNT; i++) 1611 hwwrite(vortex->mmio, VORTEX_ADB_RTBASE + (i << 2), 1612 hwread(vortex->mmio, 1613 VORTEX_ADB_RTBASE + (i << 2)) | ROUTE_MASK); 1614 for (i = 0; i < VORTEX_ADB_CHNBASE_COUNT; i++) { 1615 hwwrite(vortex->mmio, VORTEX_ADB_CHNBASE + (i << 2), 1616 hwread(vortex->mmio, 1617 VORTEX_ADB_CHNBASE + (i << 2)) | ROUTE_MASK); 1618 } 1619 } 1620 1621 static void vortex_adb_en_sr(vortex_t * vortex, int channel) 1622 { 1623 hwwrite(vortex->mmio, VORTEX_ADB_SR, 1624 hwread(vortex->mmio, VORTEX_ADB_SR) | (0x1 << channel)); 1625 } 1626 1627 static void vortex_adb_dis_sr(vortex_t * vortex, int channel) 1628 { 1629 hwwrite(vortex->mmio, VORTEX_ADB_SR, 1630 hwread(vortex->mmio, VORTEX_ADB_SR) & ~(0x1 << channel)); 1631 } 1632 1633 static void 1634 vortex_adb_addroutes(vortex_t * vortex, unsigned char channel, 1635 ADBRamLink * route, int rnum) 1636 { 1637 int temp, prev, lifeboat = 0; 1638 1639 if ((rnum <= 0) || (route == NULL)) 1640 return; 1641 /* Write last routes. */ 1642 rnum--; 1643 hwwrite(vortex->mmio, 1644 VORTEX_ADB_RTBASE + ((route[rnum] & ADB_MASK) << 2), 1645 ROUTE_MASK); 1646 while (rnum > 0) { 1647 hwwrite(vortex->mmio, 1648 VORTEX_ADB_RTBASE + 1649 ((route[rnum - 1] & ADB_MASK) << 2), route[rnum]); 1650 rnum--; 1651 } 1652 /* Write first route. */ 1653 temp = 1654 hwread(vortex->mmio, 1655 VORTEX_ADB_CHNBASE + (channel << 2)) & ADB_MASK; 1656 if (temp == ADB_MASK) { 1657 /* First entry on this channel. */ 1658 hwwrite(vortex->mmio, VORTEX_ADB_CHNBASE + (channel << 2), 1659 route[0]); 1660 vortex_adb_en_sr(vortex, channel); 1661 return; 1662 } 1663 /* Not first entry on this channel. Need to link. */ 1664 do { 1665 prev = temp; 1666 temp = 1667 hwread(vortex->mmio, 1668 VORTEX_ADB_RTBASE + (temp << 2)) & ADB_MASK; 1669 if ((lifeboat++) > ADB_MASK) { 1670 printk(KERN_ERR 1671 "vortex_adb_addroutes: unending route! 0x%x\n", 1672 *route); 1673 return; 1674 } 1675 } 1676 while (temp != ADB_MASK); 1677 hwwrite(vortex->mmio, VORTEX_ADB_RTBASE + (prev << 2), route[0]); 1678 } 1679 1680 static void 1681 vortex_adb_delroutes(vortex_t * vortex, unsigned char channel, 1682 ADBRamLink route0, ADBRamLink route1) 1683 { 1684 int temp, lifeboat = 0, prev; 1685 1686 /* Find route. */ 1687 temp = 1688 hwread(vortex->mmio, 1689 VORTEX_ADB_CHNBASE + (channel << 2)) & ADB_MASK; 1690 if (temp == (route0 & ADB_MASK)) { 1691 temp = 1692 hwread(vortex->mmio, 1693 VORTEX_ADB_RTBASE + ((route1 & ADB_MASK) << 2)); 1694 if ((temp & ADB_MASK) == ADB_MASK) 1695 vortex_adb_dis_sr(vortex, channel); 1696 hwwrite(vortex->mmio, VORTEX_ADB_CHNBASE + (channel << 2), 1697 temp); 1698 return; 1699 } 1700 do { 1701 prev = temp; 1702 temp = 1703 hwread(vortex->mmio, 1704 VORTEX_ADB_RTBASE + (prev << 2)) & ADB_MASK; 1705 if (((lifeboat++) > ADB_MASK) || (temp == ADB_MASK)) { 1706 printk(KERN_ERR 1707 "vortex_adb_delroutes: route not found! 0x%x\n", 1708 route0); 1709 return; 1710 } 1711 } 1712 while (temp != (route0 & ADB_MASK)); 1713 temp = hwread(vortex->mmio, VORTEX_ADB_RTBASE + (temp << 2)); 1714 if ((temp & ADB_MASK) == route1) 1715 temp = hwread(vortex->mmio, VORTEX_ADB_RTBASE + (temp << 2)); 1716 /* Make bridge over deleted route. */ 1717 hwwrite(vortex->mmio, VORTEX_ADB_RTBASE + (prev << 2), temp); 1718 } 1719 1720 static void 1721 vortex_route(vortex_t * vortex, int en, unsigned char channel, 1722 unsigned char source, unsigned char dest) 1723 { 1724 ADBRamLink route; 1725 1726 route = ((source & ADB_MASK) << ADB_SHIFT) | (dest & ADB_MASK); 1727 if (en) { 1728 vortex_adb_addroutes(vortex, channel, &route, 1); 1729 if ((source < (OFFSET_SRCOUT + NR_SRC)) 1730 && (source >= OFFSET_SRCOUT)) 1731 vortex_src_addWTD(vortex, (source - OFFSET_SRCOUT), 1732 channel); 1733 else if ((source < (OFFSET_MIXOUT + NR_MIXOUT)) 1734 && (source >= OFFSET_MIXOUT)) 1735 vortex_mixer_addWTD(vortex, 1736 (source - OFFSET_MIXOUT), channel); 1737 } else { 1738 vortex_adb_delroutes(vortex, channel, route, route); 1739 if ((source < (OFFSET_SRCOUT + NR_SRC)) 1740 && (source >= OFFSET_SRCOUT)) 1741 vortex_src_delWTD(vortex, (source - OFFSET_SRCOUT), 1742 channel); 1743 else if ((source < (OFFSET_MIXOUT + NR_MIXOUT)) 1744 && (source >= OFFSET_MIXOUT)) 1745 vortex_mixer_delWTD(vortex, 1746 (source - OFFSET_MIXOUT), channel); 1747 } 1748 } 1749 1750 #if 0 1751 static void 1752 vortex_routes(vortex_t * vortex, int en, unsigned char channel, 1753 unsigned char source, unsigned char dest0, unsigned char dest1) 1754 { 1755 ADBRamLink route[2]; 1756 1757 route[0] = ((source & ADB_MASK) << ADB_SHIFT) | (dest0 & ADB_MASK); 1758 route[1] = ((source & ADB_MASK) << ADB_SHIFT) | (dest1 & ADB_MASK); 1759 1760 if (en) { 1761 vortex_adb_addroutes(vortex, channel, route, 2); 1762 if ((source < (OFFSET_SRCOUT + NR_SRC)) 1763 && (source >= (OFFSET_SRCOUT))) 1764 vortex_src_addWTD(vortex, (source - OFFSET_SRCOUT), 1765 channel); 1766 else if ((source < (OFFSET_MIXOUT + NR_MIXOUT)) 1767 && (source >= (OFFSET_MIXOUT))) 1768 vortex_mixer_addWTD(vortex, 1769 (source - OFFSET_MIXOUT), channel); 1770 } else { 1771 vortex_adb_delroutes(vortex, channel, route[0], route[1]); 1772 if ((source < (OFFSET_SRCOUT + NR_SRC)) 1773 && (source >= (OFFSET_SRCOUT))) 1774 vortex_src_delWTD(vortex, (source - OFFSET_SRCOUT), 1775 channel); 1776 else if ((source < (OFFSET_MIXOUT + NR_MIXOUT)) 1777 && (source >= (OFFSET_MIXOUT))) 1778 vortex_mixer_delWTD(vortex, 1779 (source - OFFSET_MIXOUT), channel); 1780 } 1781 } 1782 1783 #endif 1784 /* Route two sources to same target. Sources must be of same class !!! */ 1785 static void 1786 vortex_routeLRT(vortex_t * vortex, int en, unsigned char ch, 1787 unsigned char source0, unsigned char source1, 1788 unsigned char dest) 1789 { 1790 ADBRamLink route[2]; 1791 1792 route[0] = ((source0 & ADB_MASK) << ADB_SHIFT) | (dest & ADB_MASK); 1793 route[1] = ((source1 & ADB_MASK) << ADB_SHIFT) | (dest & ADB_MASK); 1794 1795 if (dest < 0x10) 1796 route[1] = (route[1] & ~ADB_MASK) | (dest + 0x20); /* fifo A */ 1797 1798 if (en) { 1799 vortex_adb_addroutes(vortex, ch, route, 2); 1800 if ((source0 < (OFFSET_SRCOUT + NR_SRC)) 1801 && (source0 >= OFFSET_SRCOUT)) { 1802 vortex_src_addWTD(vortex, 1803 (source0 - OFFSET_SRCOUT), ch); 1804 vortex_src_addWTD(vortex, 1805 (source1 - OFFSET_SRCOUT), ch); 1806 } else if ((source0 < (OFFSET_MIXOUT + NR_MIXOUT)) 1807 && (source0 >= OFFSET_MIXOUT)) { 1808 vortex_mixer_addWTD(vortex, 1809 (source0 - OFFSET_MIXOUT), ch); 1810 vortex_mixer_addWTD(vortex, 1811 (source1 - OFFSET_MIXOUT), ch); 1812 } 1813 } else { 1814 vortex_adb_delroutes(vortex, ch, route[0], route[1]); 1815 if ((source0 < (OFFSET_SRCOUT + NR_SRC)) 1816 && (source0 >= OFFSET_SRCOUT)) { 1817 vortex_src_delWTD(vortex, 1818 (source0 - OFFSET_SRCOUT), ch); 1819 vortex_src_delWTD(vortex, 1820 (source1 - OFFSET_SRCOUT), ch); 1821 } else if ((source0 < (OFFSET_MIXOUT + NR_MIXOUT)) 1822 && (source0 >= OFFSET_MIXOUT)) { 1823 vortex_mixer_delWTD(vortex, 1824 (source0 - OFFSET_MIXOUT), ch); 1825 vortex_mixer_delWTD(vortex, 1826 (source1 - OFFSET_MIXOUT), ch); 1827 } 1828 } 1829 } 1830 1831 /* Connection stuff */ 1832 1833 // Connect adbdma to src('s). 1834 static void 1835 vortex_connection_adbdma_src(vortex_t * vortex, int en, unsigned char ch, 1836 unsigned char adbdma, unsigned char src) 1837 { 1838 vortex_route(vortex, en, ch, ADB_DMA(adbdma), ADB_SRCIN(src)); 1839 } 1840 1841 // Connect SRC to mixin. 1842 static void 1843 vortex_connection_src_mixin(vortex_t * vortex, int en, 1844 unsigned char channel, unsigned char src, 1845 unsigned char mixin) 1846 { 1847 vortex_route(vortex, en, channel, ADB_SRCOUT(src), ADB_MIXIN(mixin)); 1848 } 1849 1850 // Connect mixin with mix output. 1851 static void 1852 vortex_connection_mixin_mix(vortex_t * vortex, int en, unsigned char mixin, 1853 unsigned char mix, int a) 1854 { 1855 if (en) { 1856 vortex_mix_enableinput(vortex, mix, mixin); 1857 vortex_mix_setinputvolumebyte(vortex, mix, mixin, MIX_DEFIGAIN); // added to original code. 1858 } else 1859 vortex_mix_disableinput(vortex, mix, mixin, a); 1860 } 1861 1862 // Connect absolut address to mixin. 1863 static void 1864 vortex_connection_adb_mixin(vortex_t * vortex, int en, 1865 unsigned char channel, unsigned char source, 1866 unsigned char mixin) 1867 { 1868 vortex_route(vortex, en, channel, source, ADB_MIXIN(mixin)); 1869 } 1870 1871 static void 1872 vortex_connection_src_adbdma(vortex_t * vortex, int en, unsigned char ch, 1873 unsigned char src, unsigned char adbdma) 1874 { 1875 vortex_route(vortex, en, ch, ADB_SRCOUT(src), ADB_DMA(adbdma)); 1876 } 1877 1878 static void 1879 vortex_connection_src_src_adbdma(vortex_t * vortex, int en, 1880 unsigned char ch, unsigned char src0, 1881 unsigned char src1, unsigned char adbdma) 1882 { 1883 1884 vortex_routeLRT(vortex, en, ch, ADB_SRCOUT(src0), ADB_SRCOUT(src1), 1885 ADB_DMA(adbdma)); 1886 } 1887 1888 // mix to absolut address. 1889 static void 1890 vortex_connection_mix_adb(vortex_t * vortex, int en, unsigned char ch, 1891 unsigned char mix, unsigned char dest) 1892 { 1893 vortex_route(vortex, en, ch, ADB_MIXOUT(mix), dest); 1894 vortex_mix_setvolumebyte(vortex, mix, MIX_DEFOGAIN); // added to original code. 1895 } 1896 1897 // mixer to src. 1898 static void 1899 vortex_connection_mix_src(vortex_t * vortex, int en, unsigned char ch, 1900 unsigned char mix, unsigned char src) 1901 { 1902 vortex_route(vortex, en, ch, ADB_MIXOUT(mix), ADB_SRCIN(src)); 1903 vortex_mix_setvolumebyte(vortex, mix, MIX_DEFOGAIN); // added to original code. 1904 } 1905 1906 #if 0 1907 static void 1908 vortex_connection_adbdma_src_src(vortex_t * vortex, int en, 1909 unsigned char channel, 1910 unsigned char adbdma, unsigned char src0, 1911 unsigned char src1) 1912 { 1913 vortex_routes(vortex, en, channel, ADB_DMA(adbdma), 1914 ADB_SRCIN(src0), ADB_SRCIN(src1)); 1915 } 1916 1917 // Connect two mix to AdbDma. 1918 static void 1919 vortex_connection_mix_mix_adbdma(vortex_t * vortex, int en, 1920 unsigned char ch, unsigned char mix0, 1921 unsigned char mix1, unsigned char adbdma) 1922 { 1923 1924 ADBRamLink routes[2]; 1925 routes[0] = 1926 (((mix0 + 1927 OFFSET_MIXOUT) & ADB_MASK) << ADB_SHIFT) | (adbdma & ADB_MASK); 1928 routes[1] = 1929 (((mix1 + OFFSET_MIXOUT) & ADB_MASK) << ADB_SHIFT) | ((adbdma + 1930 0x20) & 1931 ADB_MASK); 1932 if (en) { 1933 vortex_adb_addroutes(vortex, ch, routes, 0x2); 1934 vortex_mixer_addWTD(vortex, mix0, ch); 1935 vortex_mixer_addWTD(vortex, mix1, ch); 1936 } else { 1937 vortex_adb_delroutes(vortex, ch, routes[0], routes[1]); 1938 vortex_mixer_delWTD(vortex, mix0, ch); 1939 vortex_mixer_delWTD(vortex, mix1, ch); 1940 } 1941 } 1942 #endif 1943 1944 /* CODEC connect. */ 1945 1946 static void 1947 vortex_connect_codecplay(vortex_t * vortex, int en, unsigned char mixers[]) 1948 { 1949 #ifdef CHIP_AU8820 1950 vortex_connection_mix_adb(vortex, en, 0x11, mixers[0], ADB_CODECOUT(0)); 1951 vortex_connection_mix_adb(vortex, en, 0x11, mixers[1], ADB_CODECOUT(1)); 1952 #else 1953 #if 1 1954 // Connect front channels through EQ. 1955 vortex_connection_mix_adb(vortex, en, 0x11, mixers[0], ADB_EQIN(0)); 1956 vortex_connection_mix_adb(vortex, en, 0x11, mixers[1], ADB_EQIN(1)); 1957 /* Lower volume, since EQ has some gain. */ 1958 vortex_mix_setvolumebyte(vortex, mixers[0], 0); 1959 vortex_mix_setvolumebyte(vortex, mixers[1], 0); 1960 vortex_route(vortex, en, 0x11, ADB_EQOUT(0), ADB_CODECOUT(0)); 1961 vortex_route(vortex, en, 0x11, ADB_EQOUT(1), ADB_CODECOUT(1)); 1962 1963 /* Check if reg 0x28 has SDAC bit set. */ 1964 if (VORTEX_IS_QUAD(vortex)) { 1965 /* Rear channel. Note: ADB_CODECOUT(0+2) and (1+2) is for AC97 modem */ 1966 vortex_connection_mix_adb(vortex, en, 0x11, mixers[2], 1967 ADB_CODECOUT(0 + 4)); 1968 vortex_connection_mix_adb(vortex, en, 0x11, mixers[3], 1969 ADB_CODECOUT(1 + 4)); 1970 /* printk(KERN_DEBUG "SDAC detected "); */ 1971 } 1972 #else 1973 // Use plain direct output to codec. 1974 vortex_connection_mix_adb(vortex, en, 0x11, mixers[0], ADB_CODECOUT(0)); 1975 vortex_connection_mix_adb(vortex, en, 0x11, mixers[1], ADB_CODECOUT(1)); 1976 #endif 1977 #endif 1978 } 1979 1980 static void 1981 vortex_connect_codecrec(vortex_t * vortex, int en, unsigned char mixin0, 1982 unsigned char mixin1) 1983 { 1984 /* 1985 Enable: 0x1, 0x1 1986 Channel: 0x11, 0x11 1987 ADB Source address: 0x48, 0x49 1988 Destination Asp4Topology_0x9c,0x98 1989 */ 1990 vortex_connection_adb_mixin(vortex, en, 0x11, ADB_CODECIN(0), mixin0); 1991 vortex_connection_adb_mixin(vortex, en, 0x11, ADB_CODECIN(1), mixin1); 1992 } 1993 1994 // Higher level ADB audio path (de)allocator. 1995 1996 /* Resource manager */ 1997 static int resnum[VORTEX_RESOURCE_LAST] = 1998 { NR_ADB, NR_SRC, NR_MIXIN, NR_MIXOUT, NR_A3D }; 1999 /* 2000 Checkout/Checkin resource of given type. 2001 resmap: resource map to be used. If NULL means that we want to allocate 2002 a DMA resource (root of all other resources of a dma channel). 2003 out: Mean checkout if != 0. Else mean Checkin resource. 2004 restype: Indicates type of resource to be checked in or out. 2005 */ 2006 static char 2007 vortex_adb_checkinout(vortex_t * vortex, int resmap[], int out, int restype) 2008 { 2009 int i, qty = resnum[restype], resinuse = 0; 2010 2011 if (out) { 2012 /* Gather used resources by all streams. */ 2013 for (i = 0; i < NR_ADB; i++) { 2014 resinuse |= vortex->dma_adb[i].resources[restype]; 2015 } 2016 resinuse |= vortex->fixed_res[restype]; 2017 /* Find and take free resource. */ 2018 for (i = 0; i < qty; i++) { 2019 if ((resinuse & (1 << i)) == 0) { 2020 if (resmap != NULL) 2021 resmap[restype] |= (1 << i); 2022 else 2023 vortex->dma_adb[i].resources[restype] |= (1 << i); 2024 /* 2025 printk(KERN_DEBUG 2026 "vortex: ResManager: type %d out %d\n", 2027 restype, i); 2028 */ 2029 return i; 2030 } 2031 } 2032 } else { 2033 if (resmap == NULL) 2034 return -EINVAL; 2035 /* Checkin first resource of type restype. */ 2036 for (i = 0; i < qty; i++) { 2037 if (resmap[restype] & (1 << i)) { 2038 resmap[restype] &= ~(1 << i); 2039 /* 2040 printk(KERN_DEBUG 2041 "vortex: ResManager: type %d in %d\n", 2042 restype, i); 2043 */ 2044 return i; 2045 } 2046 } 2047 } 2048 printk(KERN_ERR "vortex: FATAL: ResManager: resource type %d exhausted.\n", restype); 2049 return -ENOMEM; 2050 } 2051 2052 /* Default Connections */ 2053 2054 static void vortex_connect_default(vortex_t * vortex, int en) 2055 { 2056 // Connect AC97 codec. 2057 vortex->mixplayb[0] = vortex_adb_checkinout(vortex, vortex->fixed_res, en, 2058 VORTEX_RESOURCE_MIXOUT); 2059 vortex->mixplayb[1] = vortex_adb_checkinout(vortex, vortex->fixed_res, en, 2060 VORTEX_RESOURCE_MIXOUT); 2061 if (VORTEX_IS_QUAD(vortex)) { 2062 vortex->mixplayb[2] = vortex_adb_checkinout(vortex, vortex->fixed_res, en, 2063 VORTEX_RESOURCE_MIXOUT); 2064 vortex->mixplayb[3] = vortex_adb_checkinout(vortex, vortex->fixed_res, en, 2065 VORTEX_RESOURCE_MIXOUT); 2066 } 2067 vortex_connect_codecplay(vortex, en, vortex->mixplayb); 2068 2069 vortex->mixcapt[0] = vortex_adb_checkinout(vortex, vortex->fixed_res, en, 2070 VORTEX_RESOURCE_MIXIN); 2071 vortex->mixcapt[1] = vortex_adb_checkinout(vortex, vortex->fixed_res, en, 2072 VORTEX_RESOURCE_MIXIN); 2073 vortex_connect_codecrec(vortex, en, MIX_CAPT(0), MIX_CAPT(1)); 2074 2075 // Connect SPDIF 2076 #ifndef CHIP_AU8820 2077 vortex->mixspdif[0] = vortex_adb_checkinout(vortex, vortex->fixed_res, en, 2078 VORTEX_RESOURCE_MIXOUT); 2079 vortex->mixspdif[1] = vortex_adb_checkinout(vortex, vortex->fixed_res, en, 2080 VORTEX_RESOURCE_MIXOUT); 2081 vortex_connection_mix_adb(vortex, en, 0x14, vortex->mixspdif[0], 2082 ADB_SPDIFOUT(0)); 2083 vortex_connection_mix_adb(vortex, en, 0x14, vortex->mixspdif[1], 2084 ADB_SPDIFOUT(1)); 2085 #endif 2086 // Connect WT 2087 #ifndef CHIP_AU8810 2088 vortex_wt_connect(vortex, en); 2089 #endif 2090 // A3D (crosstalk canceler and A3D slices). AU8810 disabled for now. 2091 #ifndef CHIP_AU8820 2092 vortex_Vort3D_connect(vortex, en); 2093 #endif 2094 // Connect I2S 2095 2096 // Connect DSP interface for SQ3500 turbo (not here i think...) 2097 2098 // Connect AC98 modem codec 2099 2100 } 2101 2102 /* 2103 Allocate nr_ch pcm audio routes if dma < 0. If dma >= 0, existing routes 2104 are deallocated. 2105 dma: DMA engine routes to be deallocated when dma >= 0. 2106 nr_ch: Number of channels to be de/allocated. 2107 dir: direction of stream. Uses same values as substream->stream. 2108 type: Type of audio output/source (codec, spdif, i2s, dsp, etc) 2109 Return: Return allocated DMA or same DMA passed as "dma" when dma >= 0. 2110 */ 2111 static int 2112 vortex_adb_allocroute(vortex_t *vortex, int dma, int nr_ch, int dir, 2113 int type, int subdev) 2114 { 2115 stream_t *stream; 2116 int i, en; 2117 struct pcm_vol *p; 2118 2119 if (dma >= 0) { 2120 en = 0; 2121 vortex_adb_checkinout(vortex, 2122 vortex->dma_adb[dma].resources, en, 2123 VORTEX_RESOURCE_DMA); 2124 } else { 2125 en = 1; 2126 if ((dma = 2127 vortex_adb_checkinout(vortex, NULL, en, 2128 VORTEX_RESOURCE_DMA)) < 0) 2129 return -EBUSY; 2130 } 2131 2132 stream = &vortex->dma_adb[dma]; 2133 stream->dma = dma; 2134 stream->dir = dir; 2135 stream->type = type; 2136 2137 /* PLAYBACK ROUTES. */ 2138 if (dir == SNDRV_PCM_STREAM_PLAYBACK) { 2139 int src[4], mix[4], ch_top; 2140 #ifndef CHIP_AU8820 2141 int a3d = 0; 2142 #endif 2143 /* Get SRC and MIXER hardware resources. */ 2144 if (stream->type != VORTEX_PCM_SPDIF) { 2145 for (i = 0; i < nr_ch; i++) { 2146 if ((src[i] = vortex_adb_checkinout(vortex, 2147 stream->resources, en, 2148 VORTEX_RESOURCE_SRC)) < 0) { 2149 memset(stream->resources, 0, 2150 sizeof(unsigned char) * 2151 VORTEX_RESOURCE_LAST); 2152 return -EBUSY; 2153 } 2154 if (stream->type != VORTEX_PCM_A3D) { 2155 if ((mix[i] = vortex_adb_checkinout(vortex, 2156 stream->resources, 2157 en, 2158 VORTEX_RESOURCE_MIXIN)) < 0) { 2159 memset(stream->resources, 2160 0, 2161 sizeof(unsigned char) * VORTEX_RESOURCE_LAST); 2162 return -EBUSY; 2163 } 2164 } 2165 } 2166 } 2167 #ifndef CHIP_AU8820 2168 if (stream->type == VORTEX_PCM_A3D) { 2169 if ((a3d = 2170 vortex_adb_checkinout(vortex, 2171 stream->resources, en, 2172 VORTEX_RESOURCE_A3D)) < 0) { 2173 memset(stream->resources, 0, 2174 sizeof(unsigned char) * 2175 VORTEX_RESOURCE_LAST); 2176 printk(KERN_ERR "vortex: out of A3D sources. Sorry\n"); 2177 return -EBUSY; 2178 } 2179 /* (De)Initialize A3D hardware source. */ 2180 vortex_Vort3D_InitializeSource(&(vortex->a3d[a3d]), en); 2181 } 2182 /* Make SPDIF out exclusive to "spdif" device when in use. */ 2183 if ((stream->type == VORTEX_PCM_SPDIF) && (en)) { 2184 vortex_route(vortex, 0, 0x14, 2185 ADB_MIXOUT(vortex->mixspdif[0]), 2186 ADB_SPDIFOUT(0)); 2187 vortex_route(vortex, 0, 0x14, 2188 ADB_MIXOUT(vortex->mixspdif[1]), 2189 ADB_SPDIFOUT(1)); 2190 } 2191 #endif 2192 /* Make playback routes. */ 2193 for (i = 0; i < nr_ch; i++) { 2194 if (stream->type == VORTEX_PCM_ADB) { 2195 vortex_connection_adbdma_src(vortex, en, 2196 src[nr_ch - 1], 2197 dma, 2198 src[i]); 2199 vortex_connection_src_mixin(vortex, en, 2200 0x11, src[i], 2201 mix[i]); 2202 vortex_connection_mixin_mix(vortex, en, 2203 mix[i], 2204 MIX_PLAYB(i), 0); 2205 #ifndef CHIP_AU8820 2206 vortex_connection_mixin_mix(vortex, en, 2207 mix[i], 2208 MIX_SPDIF(i % 2), 0); 2209 vortex_mix_setinputvolumebyte(vortex, 2210 MIX_SPDIF(i % 2), 2211 mix[i], 2212 MIX_DEFIGAIN); 2213 #endif 2214 } 2215 #ifndef CHIP_AU8820 2216 if (stream->type == VORTEX_PCM_A3D) { 2217 vortex_connection_adbdma_src(vortex, en, 2218 src[nr_ch - 1], 2219 dma, 2220 src[i]); 2221 vortex_route(vortex, en, 0x11, ADB_SRCOUT(src[i]), ADB_A3DIN(a3d)); 2222 /* XTalk test. */ 2223 //vortex_route(vortex, en, 0x11, dma, ADB_XTALKIN(i?9:4)); 2224 //vortex_route(vortex, en, 0x11, ADB_SRCOUT(src[i]), ADB_XTALKIN(i?4:9)); 2225 } 2226 if (stream->type == VORTEX_PCM_SPDIF) 2227 vortex_route(vortex, en, 0x14, 2228 ADB_DMA(stream->dma), 2229 ADB_SPDIFOUT(i)); 2230 #endif 2231 } 2232 if (stream->type != VORTEX_PCM_SPDIF && stream->type != VORTEX_PCM_A3D) { 2233 ch_top = (VORTEX_IS_QUAD(vortex) ? 4 : 2); 2234 for (i = nr_ch; i < ch_top; i++) { 2235 vortex_connection_mixin_mix(vortex, en, 2236 mix[i % nr_ch], 2237 MIX_PLAYB(i), 0); 2238 #ifndef CHIP_AU8820 2239 vortex_connection_mixin_mix(vortex, en, 2240 mix[i % nr_ch], 2241 MIX_SPDIF(i % 2), 2242 0); 2243 vortex_mix_setinputvolumebyte(vortex, 2244 MIX_SPDIF(i % 2), 2245 mix[i % nr_ch], 2246 MIX_DEFIGAIN); 2247 #endif 2248 } 2249 if (stream->type == VORTEX_PCM_ADB && en) { 2250 p = &vortex->pcm_vol[subdev]; 2251 p->dma = dma; 2252 for (i = 0; i < nr_ch; i++) 2253 p->mixin[i] = mix[i]; 2254 for (i = 0; i < ch_top; i++) 2255 p->vol[i] = 0; 2256 } 2257 } 2258 #ifndef CHIP_AU8820 2259 else { 2260 if (nr_ch == 1 && stream->type == VORTEX_PCM_SPDIF) 2261 vortex_route(vortex, en, 0x14, 2262 ADB_DMA(stream->dma), 2263 ADB_SPDIFOUT(1)); 2264 } 2265 /* Reconnect SPDIF out when "spdif" device is down. */ 2266 if ((stream->type == VORTEX_PCM_SPDIF) && (!en)) { 2267 vortex_route(vortex, 1, 0x14, 2268 ADB_MIXOUT(vortex->mixspdif[0]), 2269 ADB_SPDIFOUT(0)); 2270 vortex_route(vortex, 1, 0x14, 2271 ADB_MIXOUT(vortex->mixspdif[1]), 2272 ADB_SPDIFOUT(1)); 2273 } 2274 #endif 2275 /* CAPTURE ROUTES. */ 2276 } else { 2277 int src[2], mix[2]; 2278 2279 /* Get SRC and MIXER hardware resources. */ 2280 for (i = 0; i < nr_ch; i++) { 2281 if ((mix[i] = 2282 vortex_adb_checkinout(vortex, 2283 stream->resources, en, 2284 VORTEX_RESOURCE_MIXOUT)) 2285 < 0) { 2286 memset(stream->resources, 0, 2287 sizeof(unsigned char) * 2288 VORTEX_RESOURCE_LAST); 2289 return -EBUSY; 2290 } 2291 if ((src[i] = 2292 vortex_adb_checkinout(vortex, 2293 stream->resources, en, 2294 VORTEX_RESOURCE_SRC)) < 0) { 2295 memset(stream->resources, 0, 2296 sizeof(unsigned char) * 2297 VORTEX_RESOURCE_LAST); 2298 return -EBUSY; 2299 } 2300 } 2301 2302 /* Make capture routes. */ 2303 vortex_connection_mixin_mix(vortex, en, MIX_CAPT(0), mix[0], 0); 2304 vortex_connection_mix_src(vortex, en, 0x11, mix[0], src[0]); 2305 if (nr_ch == 1) { 2306 vortex_connection_mixin_mix(vortex, en, 2307 MIX_CAPT(1), mix[0], 0); 2308 vortex_connection_src_adbdma(vortex, en, 2309 src[0], 2310 src[0], dma); 2311 } else { 2312 vortex_connection_mixin_mix(vortex, en, 2313 MIX_CAPT(1), mix[1], 0); 2314 vortex_connection_mix_src(vortex, en, 0x11, mix[1], 2315 src[1]); 2316 vortex_connection_src_src_adbdma(vortex, en, 2317 src[1], src[0], 2318 src[1], dma); 2319 } 2320 } 2321 vortex->dma_adb[dma].nr_ch = nr_ch; 2322 2323 #if 0 2324 /* AC97 Codec channel setup. FIXME: this has no effect on some cards !! */ 2325 if (nr_ch < 4) { 2326 /* Copy stereo to rear channel (surround) */ 2327 snd_ac97_write_cache(vortex->codec, 2328 AC97_SIGMATEL_DAC2INVERT, 2329 snd_ac97_read(vortex->codec, 2330 AC97_SIGMATEL_DAC2INVERT) 2331 | 4); 2332 } else { 2333 /* Allow separate front and rear channels. */ 2334 snd_ac97_write_cache(vortex->codec, 2335 AC97_SIGMATEL_DAC2INVERT, 2336 snd_ac97_read(vortex->codec, 2337 AC97_SIGMATEL_DAC2INVERT) 2338 & ~((u32) 2339 4)); 2340 } 2341 #endif 2342 return dma; 2343 } 2344 2345 /* 2346 Set the SampleRate of the SRC's attached to the given DMA engine. 2347 */ 2348 static void 2349 vortex_adb_setsrc(vortex_t * vortex, int adbdma, unsigned int rate, int dir) 2350 { 2351 stream_t *stream = &(vortex->dma_adb[adbdma]); 2352 int i, cvrt; 2353 2354 /* dir=1:play ; dir=0:rec */ 2355 if (dir) 2356 cvrt = SRC_RATIO(rate, 48000); 2357 else 2358 cvrt = SRC_RATIO(48000, rate); 2359 2360 /* Setup SRC's */ 2361 for (i = 0; i < NR_SRC; i++) { 2362 if (stream->resources[VORTEX_RESOURCE_SRC] & (1 << i)) 2363 vortex_src_setupchannel(vortex, i, cvrt, 0, 0, i, dir, 1, cvrt, dir); 2364 } 2365 } 2366 2367 // Timer and ISR functions. 2368 2369 static void vortex_settimer(vortex_t * vortex, int period) 2370 { 2371 //set the timer period to <period> 48000ths of a second. 2372 hwwrite(vortex->mmio, VORTEX_IRQ_STAT, period); 2373 } 2374 2375 #if 0 2376 static void vortex_enable_timer_int(vortex_t * card) 2377 { 2378 hwwrite(card->mmio, VORTEX_IRQ_CTRL, 2379 hwread(card->mmio, VORTEX_IRQ_CTRL) | IRQ_TIMER | 0x60); 2380 } 2381 2382 static void vortex_disable_timer_int(vortex_t * card) 2383 { 2384 hwwrite(card->mmio, VORTEX_IRQ_CTRL, 2385 hwread(card->mmio, VORTEX_IRQ_CTRL) & ~IRQ_TIMER); 2386 } 2387 2388 #endif 2389 static void vortex_enable_int(vortex_t * card) 2390 { 2391 // CAsp4ISR__EnableVortexInt_void_ 2392 hwwrite(card->mmio, VORTEX_CTRL, 2393 hwread(card->mmio, VORTEX_CTRL) | CTRL_IRQ_ENABLE); 2394 hwwrite(card->mmio, VORTEX_IRQ_CTRL, 2395 (hwread(card->mmio, VORTEX_IRQ_CTRL) & 0xffffefc0) | 0x24); 2396 } 2397 2398 static void vortex_disable_int(vortex_t * card) 2399 { 2400 hwwrite(card->mmio, VORTEX_CTRL, 2401 hwread(card->mmio, VORTEX_CTRL) & ~CTRL_IRQ_ENABLE); 2402 } 2403 2404 static irqreturn_t vortex_interrupt(int irq, void *dev_id) 2405 { 2406 vortex_t *vortex = dev_id; 2407 int i, handled; 2408 u32 source; 2409 2410 //check if the interrupt is ours. 2411 if (!(hwread(vortex->mmio, VORTEX_STAT) & 0x1)) 2412 return IRQ_NONE; 2413 2414 // This is the Interrupt Enable flag we set before (consistency check). 2415 if (!(hwread(vortex->mmio, VORTEX_CTRL) & CTRL_IRQ_ENABLE)) 2416 return IRQ_NONE; 2417 2418 source = hwread(vortex->mmio, VORTEX_IRQ_SOURCE); 2419 // Reset IRQ flags. 2420 hwwrite(vortex->mmio, VORTEX_IRQ_SOURCE, source); 2421 hwread(vortex->mmio, VORTEX_IRQ_SOURCE); 2422 // Is at least one IRQ flag set? 2423 if (source == 0) { 2424 printk(KERN_ERR "vortex: missing irq source\n"); 2425 return IRQ_NONE; 2426 } 2427 2428 handled = 0; 2429 // Attend every interrupt source. 2430 if (unlikely(source & IRQ_ERR_MASK)) { 2431 if (source & IRQ_FATAL) { 2432 printk(KERN_ERR "vortex: IRQ fatal error\n"); 2433 } 2434 if (source & IRQ_PARITY) { 2435 printk(KERN_ERR "vortex: IRQ parity error\n"); 2436 } 2437 if (source & IRQ_REG) { 2438 printk(KERN_ERR "vortex: IRQ reg error\n"); 2439 } 2440 if (source & IRQ_FIFO) { 2441 printk(KERN_ERR "vortex: IRQ fifo error\n"); 2442 } 2443 if (source & IRQ_DMA) { 2444 printk(KERN_ERR "vortex: IRQ dma error\n"); 2445 } 2446 handled = 1; 2447 } 2448 if (source & IRQ_PCMOUT) { 2449 /* ALSA period acknowledge. */ 2450 spin_lock(&vortex->lock); 2451 for (i = 0; i < NR_ADB; i++) { 2452 if (vortex->dma_adb[i].fifo_status == FIFO_START) { 2453 if (!vortex_adbdma_bufshift(vortex, i)) 2454 continue; 2455 spin_unlock(&vortex->lock); 2456 snd_pcm_period_elapsed(vortex->dma_adb[i]. 2457 substream); 2458 spin_lock(&vortex->lock); 2459 } 2460 } 2461 #ifndef CHIP_AU8810 2462 for (i = 0; i < NR_WT; i++) { 2463 if (vortex->dma_wt[i].fifo_status == FIFO_START) { 2464 /* FIXME: we ignore the return value from 2465 * vortex_wtdma_bufshift() below as the delta 2466 * calculation seems not working for wavetable 2467 * by some reason 2468 */ 2469 vortex_wtdma_bufshift(vortex, i); 2470 spin_unlock(&vortex->lock); 2471 snd_pcm_period_elapsed(vortex->dma_wt[i]. 2472 substream); 2473 spin_lock(&vortex->lock); 2474 } 2475 } 2476 #endif 2477 spin_unlock(&vortex->lock); 2478 handled = 1; 2479 } 2480 //Acknowledge the Timer interrupt 2481 if (source & IRQ_TIMER) { 2482 hwread(vortex->mmio, VORTEX_IRQ_STAT); 2483 handled = 1; 2484 } 2485 if ((source & IRQ_MIDI) && vortex->rmidi) { 2486 snd_mpu401_uart_interrupt(vortex->irq, 2487 vortex->rmidi->private_data); 2488 handled = 1; 2489 } 2490 2491 if (!handled) { 2492 printk(KERN_ERR "vortex: unknown irq source %x\n", source); 2493 } 2494 return IRQ_RETVAL(handled); 2495 } 2496 2497 /* Codec */ 2498 2499 #define POLL_COUNT 1000 2500 static void vortex_codec_init(vortex_t * vortex) 2501 { 2502 int i; 2503 2504 for (i = 0; i < 32; i++) { 2505 /* the windows driver writes -i, so we write -i */ 2506 hwwrite(vortex->mmio, (VORTEX_CODEC_CHN + (i << 2)), -i); 2507 msleep(2); 2508 } 2509 if (0) { 2510 hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0x8068); 2511 msleep(1); 2512 hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0x00e8); 2513 msleep(1); 2514 } else { 2515 hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0x00a8); 2516 msleep(2); 2517 hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0x80a8); 2518 msleep(2); 2519 hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0x80e8); 2520 msleep(2); 2521 hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0x80a8); 2522 msleep(2); 2523 hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0x00a8); 2524 msleep(2); 2525 hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0x00e8); 2526 } 2527 for (i = 0; i < 32; i++) { 2528 hwwrite(vortex->mmio, (VORTEX_CODEC_CHN + (i << 2)), -i); 2529 msleep(5); 2530 } 2531 hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0xe8); 2532 msleep(1); 2533 /* Enable codec channels 0 and 1. */ 2534 hwwrite(vortex->mmio, VORTEX_CODEC_EN, 2535 hwread(vortex->mmio, VORTEX_CODEC_EN) | EN_CODEC); 2536 } 2537 2538 static void 2539 vortex_codec_write(struct snd_ac97 * codec, unsigned short addr, unsigned short data) 2540 { 2541 2542 vortex_t *card = (vortex_t *) codec->private_data; 2543 unsigned int lifeboat = 0; 2544 2545 /* wait for transactions to clear */ 2546 while (!(hwread(card->mmio, VORTEX_CODEC_CTRL) & 0x100)) { 2547 udelay(100); 2548 if (lifeboat++ > POLL_COUNT) { 2549 printk(KERN_ERR "vortex: ac97 codec stuck busy\n"); 2550 return; 2551 } 2552 } 2553 /* write register */ 2554 hwwrite(card->mmio, VORTEX_CODEC_IO, 2555 ((addr << VORTEX_CODEC_ADDSHIFT) & VORTEX_CODEC_ADDMASK) | 2556 ((data << VORTEX_CODEC_DATSHIFT) & VORTEX_CODEC_DATMASK) | 2557 VORTEX_CODEC_WRITE | 2558 (codec->num << VORTEX_CODEC_ID_SHIFT) ); 2559 2560 /* Flush Caches. */ 2561 hwread(card->mmio, VORTEX_CODEC_IO); 2562 } 2563 2564 static unsigned short vortex_codec_read(struct snd_ac97 * codec, unsigned short addr) 2565 { 2566 2567 vortex_t *card = (vortex_t *) codec->private_data; 2568 u32 read_addr, data; 2569 unsigned lifeboat = 0; 2570 2571 /* wait for transactions to clear */ 2572 while (!(hwread(card->mmio, VORTEX_CODEC_CTRL) & 0x100)) { 2573 udelay(100); 2574 if (lifeboat++ > POLL_COUNT) { 2575 printk(KERN_ERR "vortex: ac97 codec stuck busy\n"); 2576 return 0xffff; 2577 } 2578 } 2579 /* set up read address */ 2580 read_addr = ((addr << VORTEX_CODEC_ADDSHIFT) & VORTEX_CODEC_ADDMASK) | 2581 (codec->num << VORTEX_CODEC_ID_SHIFT) ; 2582 hwwrite(card->mmio, VORTEX_CODEC_IO, read_addr); 2583 2584 /* wait for address */ 2585 do { 2586 udelay(100); 2587 data = hwread(card->mmio, VORTEX_CODEC_IO); 2588 if (lifeboat++ > POLL_COUNT) { 2589 printk(KERN_ERR "vortex: ac97 address never arrived\n"); 2590 return 0xffff; 2591 } 2592 } while ((data & VORTEX_CODEC_ADDMASK) != 2593 (addr << VORTEX_CODEC_ADDSHIFT)); 2594 2595 /* return data. */ 2596 return (u16) (data & VORTEX_CODEC_DATMASK); 2597 } 2598 2599 /* SPDIF support */ 2600 2601 static void vortex_spdif_init(vortex_t * vortex, int spdif_sr, int spdif_mode) 2602 { 2603 int i, this_38 = 0, this_04 = 0, this_08 = 0, this_0c = 0; 2604 2605 /* CAsp4Spdif::InitializeSpdifHardware(void) */ 2606 hwwrite(vortex->mmio, VORTEX_SPDIF_FLAGS, 2607 hwread(vortex->mmio, VORTEX_SPDIF_FLAGS) & 0xfff3fffd); 2608 //for (i=0x291D4; i<0x29200; i+=4) 2609 for (i = 0; i < 11; i++) 2610 hwwrite(vortex->mmio, VORTEX_SPDIF_CFG1 + (i << 2), 0); 2611 //hwwrite(vortex->mmio, 0x29190, hwread(vortex->mmio, 0x29190) | 0xc0000); 2612 hwwrite(vortex->mmio, VORTEX_CODEC_EN, 2613 hwread(vortex->mmio, VORTEX_CODEC_EN) | EN_SPDIF); 2614 2615 /* CAsp4Spdif::ProgramSRCInHardware(enum SPDIF_SR,enum SPDIFMODE) */ 2616 if (this_04 && this_08) { 2617 int edi; 2618 2619 i = (((0x5DC00000 / spdif_sr) + 1) >> 1); 2620 if (i > 0x800) { 2621 if (i < 0x1ffff) 2622 edi = (i >> 1); 2623 else 2624 edi = 0x1ffff; 2625 } else { 2626 i = edi = 0x800; 2627 } 2628 /* this_04 and this_08 are the CASp4Src's (samplerate converters) */ 2629 vortex_src_setupchannel(vortex, this_04, edi, 0, 1, 2630 this_0c, 1, 0, edi, 1); 2631 vortex_src_setupchannel(vortex, this_08, edi, 0, 1, 2632 this_0c, 1, 0, edi, 1); 2633 } 2634 2635 i = spdif_sr; 2636 spdif_sr |= 0x8c; 2637 switch (i) { 2638 case 32000: 2639 this_38 &= 0xFFFFFFFE; 2640 this_38 &= 0xFFFFFFFD; 2641 this_38 &= 0xF3FFFFFF; 2642 this_38 |= 0x03000000; /* set 32khz samplerate */ 2643 this_38 &= 0xFFFFFF3F; 2644 spdif_sr &= 0xFFFFFFFD; 2645 spdif_sr |= 1; 2646 break; 2647 case 44100: 2648 this_38 &= 0xFFFFFFFE; 2649 this_38 &= 0xFFFFFFFD; 2650 this_38 &= 0xF0FFFFFF; 2651 this_38 |= 0x03000000; 2652 this_38 &= 0xFFFFFF3F; 2653 spdif_sr &= 0xFFFFFFFC; 2654 break; 2655 case 48000: 2656 if (spdif_mode == 1) { 2657 this_38 &= 0xFFFFFFFE; 2658 this_38 &= 0xFFFFFFFD; 2659 this_38 &= 0xF2FFFFFF; 2660 this_38 |= 0x02000000; /* set 48khz samplerate */ 2661 this_38 &= 0xFFFFFF3F; 2662 } else { 2663 /* J. Gordon Wolfe: I think this stuff is for AC3 */ 2664 this_38 |= 0x00000003; 2665 this_38 &= 0xFFFFFFBF; 2666 this_38 |= 0x80; 2667 } 2668 spdif_sr |= 2; 2669 spdif_sr &= 0xFFFFFFFE; 2670 break; 2671 2672 } 2673 /* looks like the next 2 lines transfer a 16-bit value into 2 8-bit 2674 registers. seems to be for the standard IEC/SPDIF initialization 2675 stuff */ 2676 hwwrite(vortex->mmio, VORTEX_SPDIF_CFG0, this_38 & 0xffff); 2677 hwwrite(vortex->mmio, VORTEX_SPDIF_CFG1, this_38 >> 0x10); 2678 hwwrite(vortex->mmio, VORTEX_SPDIF_SMPRATE, spdif_sr); 2679 } 2680 2681 /* Initialization */ 2682 2683 static int vortex_core_init(vortex_t *vortex) 2684 { 2685 2686 printk(KERN_INFO "Vortex: init.... "); 2687 /* Hardware Init. */ 2688 hwwrite(vortex->mmio, VORTEX_CTRL, 0xffffffff); 2689 msleep(5); 2690 hwwrite(vortex->mmio, VORTEX_CTRL, 2691 hwread(vortex->mmio, VORTEX_CTRL) & 0xffdfffff); 2692 msleep(5); 2693 /* Reset IRQ flags */ 2694 hwwrite(vortex->mmio, VORTEX_IRQ_SOURCE, 0xffffffff); 2695 hwread(vortex->mmio, VORTEX_IRQ_STAT); 2696 2697 vortex_codec_init(vortex); 2698 2699 #ifdef CHIP_AU8830 2700 hwwrite(vortex->mmio, VORTEX_CTRL, 2701 hwread(vortex->mmio, VORTEX_CTRL) | 0x1000000); 2702 #endif 2703 2704 /* Init audio engine. */ 2705 vortex_adbdma_init(vortex); 2706 hwwrite(vortex->mmio, VORTEX_ENGINE_CTRL, 0x0); //, 0xc83c7e58, 0xc5f93e58 2707 vortex_adb_init(vortex); 2708 /* Init processing blocks. */ 2709 vortex_fifo_init(vortex); 2710 vortex_mixer_init(vortex); 2711 vortex_srcblock_init(vortex); 2712 #ifndef CHIP_AU8820 2713 vortex_eq_init(vortex); 2714 vortex_spdif_init(vortex, 48000, 1); 2715 vortex_Vort3D_enable(vortex); 2716 #endif 2717 #ifndef CHIP_AU8810 2718 vortex_wt_init(vortex); 2719 #endif 2720 // Moved to au88x0.c 2721 //vortex_connect_default(vortex, 1); 2722 2723 vortex_settimer(vortex, 0x90); 2724 // Enable Interrupts. 2725 // vortex_enable_int() must be first !! 2726 // hwwrite(vortex->mmio, VORTEX_IRQ_CTRL, 0); 2727 // vortex_enable_int(vortex); 2728 //vortex_enable_timer_int(vortex); 2729 //vortex_disable_timer_int(vortex); 2730 2731 printk(KERN_INFO "done.\n"); 2732 spin_lock_init(&vortex->lock); 2733 2734 return 0; 2735 } 2736 2737 static int vortex_core_shutdown(vortex_t * vortex) 2738 { 2739 2740 printk(KERN_INFO "Vortex: shutdown..."); 2741 #ifndef CHIP_AU8820 2742 vortex_eq_free(vortex); 2743 vortex_Vort3D_disable(vortex); 2744 #endif 2745 //vortex_disable_timer_int(vortex); 2746 vortex_disable_int(vortex); 2747 vortex_connect_default(vortex, 0); 2748 /* Reset all DMA fifos. */ 2749 vortex_fifo_init(vortex); 2750 /* Erase all audio routes. */ 2751 vortex_adb_init(vortex); 2752 2753 /* Disable MPU401 */ 2754 //hwwrite(vortex->mmio, VORTEX_IRQ_CTRL, hwread(vortex->mmio, VORTEX_IRQ_CTRL) & ~IRQ_MIDI); 2755 //hwwrite(vortex->mmio, VORTEX_CTRL, hwread(vortex->mmio, VORTEX_CTRL) & ~CTRL_MIDI_EN); 2756 2757 hwwrite(vortex->mmio, VORTEX_IRQ_CTRL, 0); 2758 hwwrite(vortex->mmio, VORTEX_CTRL, 0); 2759 msleep(5); 2760 hwwrite(vortex->mmio, VORTEX_IRQ_SOURCE, 0xffff); 2761 2762 printk(KERN_INFO "done.\n"); 2763 return 0; 2764 } 2765 2766 /* Alsa support. */ 2767 2768 static int vortex_alsafmt_aspfmt(int alsafmt) 2769 { 2770 int fmt; 2771 2772 switch (alsafmt) { 2773 case SNDRV_PCM_FORMAT_U8: 2774 fmt = 0x1; 2775 break; 2776 case SNDRV_PCM_FORMAT_MU_LAW: 2777 fmt = 0x2; 2778 break; 2779 case SNDRV_PCM_FORMAT_A_LAW: 2780 fmt = 0x3; 2781 break; 2782 case SNDRV_PCM_FORMAT_SPECIAL: 2783 fmt = 0x4; /* guess. */ 2784 break; 2785 case SNDRV_PCM_FORMAT_IEC958_SUBFRAME_LE: 2786 fmt = 0x5; /* guess. */ 2787 break; 2788 case SNDRV_PCM_FORMAT_S16_LE: 2789 fmt = 0x8; 2790 break; 2791 case SNDRV_PCM_FORMAT_S16_BE: 2792 fmt = 0x9; /* check this... */ 2793 break; 2794 default: 2795 fmt = 0x8; 2796 printk(KERN_ERR "vortex: format unsupported %d\n", alsafmt); 2797 break; 2798 } 2799 return fmt; 2800 } 2801 2802 /* Some not yet useful translations. */ 2803 #if 0 2804 typedef enum { 2805 ASPFMTLINEAR16 = 0, /* 0x8 */ 2806 ASPFMTLINEAR8, /* 0x1 */ 2807 ASPFMTULAW, /* 0x2 */ 2808 ASPFMTALAW, /* 0x3 */ 2809 ASPFMTSPORT, /* ? */ 2810 ASPFMTSPDIF, /* ? */ 2811 } ASPENCODING; 2812 2813 static int 2814 vortex_translateformat(vortex_t * vortex, char bits, char nch, int encod) 2815 { 2816 int a, this_194; 2817 2818 if ((bits != 8) && (bits != 16)) 2819 return -1; 2820 2821 switch (encod) { 2822 case 0: 2823 if (bits == 0x10) 2824 a = 8; // 16 bit 2825 break; 2826 case 1: 2827 if (bits == 8) 2828 a = 1; // 8 bit 2829 break; 2830 case 2: 2831 a = 2; // U_LAW 2832 break; 2833 case 3: 2834 a = 3; // A_LAW 2835 break; 2836 } 2837 switch (nch) { 2838 case 1: 2839 this_194 = 0; 2840 break; 2841 case 2: 2842 this_194 = 1; 2843 break; 2844 case 4: 2845 this_194 = 1; 2846 break; 2847 case 6: 2848 this_194 = 1; 2849 break; 2850 } 2851 return (a); 2852 } 2853 2854 static void vortex_cdmacore_setformat(vortex_t * vortex, int bits, int nch) 2855 { 2856 short int d, this_148; 2857 2858 d = ((bits >> 3) * nch); 2859 this_148 = 0xbb80 / d; 2860 } 2861 #endif 2862