1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 */ 4 5 /* 6 * 2002-07 Benny Sjostrand benny@hostmobility.com 7 */ 8 9 10 #include <linux/io.h> 11 #include <linux/delay.h> 12 #include <linux/pm.h> 13 #include <linux/init.h> 14 #include <linux/slab.h> 15 #include <linux/mutex.h> 16 17 #include <sound/core.h> 18 #include <sound/control.h> 19 #include <sound/info.h> 20 #include "cs46xx.h" 21 22 #include "cs46xx_lib.h" 23 #include "dsp_spos.h" 24 25 struct proc_scb_info { 26 struct dsp_scb_descriptor * scb_desc; 27 struct snd_cs46xx *chip; 28 }; 29 30 static void remove_symbol (struct snd_cs46xx * chip, struct dsp_symbol_entry * symbol) 31 { 32 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 33 int symbol_index = (int)(symbol - ins->symbol_table.symbols); 34 35 if (snd_BUG_ON(ins->symbol_table.nsymbols <= 0)) 36 return; 37 if (snd_BUG_ON(symbol_index < 0 || 38 symbol_index >= ins->symbol_table.nsymbols)) 39 return; 40 41 ins->symbol_table.symbols[symbol_index].deleted = 1; 42 43 if (symbol_index < ins->symbol_table.highest_frag_index) { 44 ins->symbol_table.highest_frag_index = symbol_index; 45 } 46 47 if (symbol_index == ins->symbol_table.nsymbols - 1) 48 ins->symbol_table.nsymbols --; 49 50 if (ins->symbol_table.highest_frag_index > ins->symbol_table.nsymbols) { 51 ins->symbol_table.highest_frag_index = ins->symbol_table.nsymbols; 52 } 53 54 } 55 56 #ifdef CONFIG_SND_PROC_FS 57 static void cs46xx_dsp_proc_scb_info_read (struct snd_info_entry *entry, 58 struct snd_info_buffer *buffer) 59 { 60 struct proc_scb_info * scb_info = entry->private_data; 61 struct dsp_scb_descriptor * scb = scb_info->scb_desc; 62 struct snd_cs46xx *chip = scb_info->chip; 63 int j,col; 64 void __iomem *dst = chip->region.idx[1].remap_addr + DSP_PARAMETER_BYTE_OFFSET; 65 66 mutex_lock(&chip->spos_mutex); 67 snd_iprintf(buffer,"%04x %s:\n",scb->address,scb->scb_name); 68 69 for (col = 0,j = 0;j < 0x10; j++,col++) { 70 if (col == 4) { 71 snd_iprintf(buffer,"\n"); 72 col = 0; 73 } 74 snd_iprintf(buffer,"%08x ",readl(dst + (scb->address + j) * sizeof(u32))); 75 } 76 77 snd_iprintf(buffer,"\n"); 78 79 if (scb->parent_scb_ptr != NULL) { 80 snd_iprintf(buffer,"parent [%s:%04x] ", 81 scb->parent_scb_ptr->scb_name, 82 scb->parent_scb_ptr->address); 83 } else snd_iprintf(buffer,"parent [none] "); 84 85 snd_iprintf(buffer,"sub_list_ptr [%s:%04x]\nnext_scb_ptr [%s:%04x] task_entry [%s:%04x]\n", 86 scb->sub_list_ptr->scb_name, 87 scb->sub_list_ptr->address, 88 scb->next_scb_ptr->scb_name, 89 scb->next_scb_ptr->address, 90 scb->task_entry->symbol_name, 91 scb->task_entry->address); 92 93 snd_iprintf(buffer,"index [%d] ref_count [%d]\n",scb->index,scb->ref_count); 94 mutex_unlock(&chip->spos_mutex); 95 } 96 #endif 97 98 static void _dsp_unlink_scb (struct snd_cs46xx *chip, struct dsp_scb_descriptor * scb) 99 { 100 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 101 102 if ( scb->parent_scb_ptr ) { 103 /* unlink parent SCB */ 104 if (snd_BUG_ON(scb->parent_scb_ptr->sub_list_ptr != scb && 105 scb->parent_scb_ptr->next_scb_ptr != scb)) 106 return; 107 108 if (scb->parent_scb_ptr->sub_list_ptr == scb) { 109 110 if (scb->next_scb_ptr == ins->the_null_scb) { 111 /* last and only node in parent sublist */ 112 scb->parent_scb_ptr->sub_list_ptr = scb->sub_list_ptr; 113 114 if (scb->sub_list_ptr != ins->the_null_scb) { 115 scb->sub_list_ptr->parent_scb_ptr = scb->parent_scb_ptr; 116 } 117 scb->sub_list_ptr = ins->the_null_scb; 118 } else { 119 /* first node in parent sublist */ 120 scb->parent_scb_ptr->sub_list_ptr = scb->next_scb_ptr; 121 122 if (scb->next_scb_ptr != ins->the_null_scb) { 123 /* update next node parent ptr. */ 124 scb->next_scb_ptr->parent_scb_ptr = scb->parent_scb_ptr; 125 } 126 scb->next_scb_ptr = ins->the_null_scb; 127 } 128 } else { 129 scb->parent_scb_ptr->next_scb_ptr = scb->next_scb_ptr; 130 131 if (scb->next_scb_ptr != ins->the_null_scb) { 132 /* update next node parent ptr. */ 133 scb->next_scb_ptr->parent_scb_ptr = scb->parent_scb_ptr; 134 } 135 scb->next_scb_ptr = ins->the_null_scb; 136 } 137 138 /* update parent first entry in DSP RAM */ 139 cs46xx_dsp_spos_update_scb(chip,scb->parent_scb_ptr); 140 141 /* then update entry in DSP RAM */ 142 cs46xx_dsp_spos_update_scb(chip,scb); 143 144 scb->parent_scb_ptr = NULL; 145 } 146 } 147 148 static void _dsp_clear_sample_buffer (struct snd_cs46xx *chip, u32 sample_buffer_addr, 149 int dword_count) 150 { 151 void __iomem *dst = chip->region.idx[2].remap_addr + sample_buffer_addr; 152 int i; 153 154 for (i = 0; i < dword_count ; ++i ) { 155 writel(0, dst); 156 dst += 4; 157 } 158 } 159 160 void cs46xx_dsp_remove_scb (struct snd_cs46xx *chip, struct dsp_scb_descriptor * scb) 161 { 162 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 163 unsigned long flags; 164 165 /* check integrety */ 166 if (snd_BUG_ON(scb->index < 0 || 167 scb->index >= ins->nscb || 168 (ins->scbs + scb->index) != scb)) 169 return; 170 171 #if 0 172 /* can't remove a SCB with childs before 173 removing childs first */ 174 if (snd_BUG_ON(scb->sub_list_ptr != ins->the_null_scb || 175 scb->next_scb_ptr != ins->the_null_scb)) 176 goto _end; 177 #endif 178 179 spin_lock_irqsave(&chip->reg_lock, flags); 180 _dsp_unlink_scb (chip,scb); 181 spin_unlock_irqrestore(&chip->reg_lock, flags); 182 183 cs46xx_dsp_proc_free_scb_desc(scb); 184 if (snd_BUG_ON(!scb->scb_symbol)) 185 return; 186 remove_symbol (chip,scb->scb_symbol); 187 188 ins->scbs[scb->index].deleted = 1; 189 #ifdef CONFIG_PM_SLEEP 190 kfree(ins->scbs[scb->index].data); 191 ins->scbs[scb->index].data = NULL; 192 #endif 193 194 if (scb->index < ins->scb_highest_frag_index) 195 ins->scb_highest_frag_index = scb->index; 196 197 if (scb->index == ins->nscb - 1) { 198 ins->nscb --; 199 } 200 201 if (ins->scb_highest_frag_index > ins->nscb) { 202 ins->scb_highest_frag_index = ins->nscb; 203 } 204 205 #if 0 206 /* !!!! THIS IS A PIECE OF SHIT MADE BY ME !!! */ 207 for(i = scb->index + 1;i < ins->nscb; ++i) { 208 ins->scbs[i - 1].index = i - 1; 209 } 210 #endif 211 } 212 213 214 #ifdef CONFIG_SND_PROC_FS 215 void cs46xx_dsp_proc_free_scb_desc (struct dsp_scb_descriptor * scb) 216 { 217 if (scb->proc_info) { 218 struct proc_scb_info * scb_info = scb->proc_info->private_data; 219 struct snd_cs46xx *chip = scb_info->chip; 220 221 dev_dbg(chip->card->dev, 222 "cs46xx_dsp_proc_free_scb_desc: freeing %s\n", 223 scb->scb_name); 224 225 snd_info_free_entry(scb->proc_info); 226 scb->proc_info = NULL; 227 228 kfree (scb_info); 229 } 230 } 231 232 void cs46xx_dsp_proc_register_scb_desc (struct snd_cs46xx *chip, 233 struct dsp_scb_descriptor * scb) 234 { 235 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 236 struct snd_info_entry * entry; 237 struct proc_scb_info * scb_info; 238 239 /* register to proc */ 240 if (ins->snd_card != NULL && ins->proc_dsp_dir != NULL && 241 scb->proc_info == NULL) { 242 243 entry = snd_info_create_card_entry(ins->snd_card, scb->scb_name, 244 ins->proc_dsp_dir); 245 if (entry) { 246 scb_info = kmalloc(sizeof(struct proc_scb_info), GFP_KERNEL); 247 if (!scb_info) { 248 snd_info_free_entry(entry); 249 entry = NULL; 250 goto out; 251 } 252 253 scb_info->chip = chip; 254 scb_info->scb_desc = scb; 255 snd_info_set_text_ops(entry, scb_info, 256 cs46xx_dsp_proc_scb_info_read); 257 } 258 out: 259 scb->proc_info = entry; 260 } 261 } 262 #endif /* CONFIG_SND_PROC_FS */ 263 264 static struct dsp_scb_descriptor * 265 _dsp_create_generic_scb (struct snd_cs46xx *chip, char * name, u32 * scb_data, u32 dest, 266 struct dsp_symbol_entry * task_entry, 267 struct dsp_scb_descriptor * parent_scb, 268 int scb_child_type) 269 { 270 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 271 struct dsp_scb_descriptor * scb; 272 273 unsigned long flags; 274 275 if (snd_BUG_ON(!ins->the_null_scb)) 276 return NULL; 277 278 /* fill the data that will be wroten to DSP */ 279 scb_data[SCBsubListPtr] = 280 (ins->the_null_scb->address << 0x10) | ins->the_null_scb->address; 281 282 scb_data[SCBfuncEntryPtr] &= 0xFFFF0000; 283 scb_data[SCBfuncEntryPtr] |= task_entry->address; 284 285 dev_dbg(chip->card->dev, "dsp_spos: creating SCB <%s>\n", name); 286 287 scb = cs46xx_dsp_create_scb(chip,name,scb_data,dest); 288 289 290 scb->sub_list_ptr = ins->the_null_scb; 291 scb->next_scb_ptr = ins->the_null_scb; 292 293 scb->parent_scb_ptr = parent_scb; 294 scb->task_entry = task_entry; 295 296 297 /* update parent SCB */ 298 if (scb->parent_scb_ptr) { 299 #if 0 300 dev_dbg(chip->card->dev, 301 "scb->parent_scb_ptr = %s\n", 302 scb->parent_scb_ptr->scb_name); 303 dev_dbg(chip->card->dev, 304 "scb->parent_scb_ptr->next_scb_ptr = %s\n", 305 scb->parent_scb_ptr->next_scb_ptr->scb_name); 306 dev_dbg(chip->card->dev, 307 "scb->parent_scb_ptr->sub_list_ptr = %s\n", 308 scb->parent_scb_ptr->sub_list_ptr->scb_name); 309 #endif 310 /* link to parent SCB */ 311 if (scb_child_type == SCB_ON_PARENT_NEXT_SCB) { 312 if (snd_BUG_ON(scb->parent_scb_ptr->next_scb_ptr != 313 ins->the_null_scb)) 314 return NULL; 315 316 scb->parent_scb_ptr->next_scb_ptr = scb; 317 318 } else if (scb_child_type == SCB_ON_PARENT_SUBLIST_SCB) { 319 if (snd_BUG_ON(scb->parent_scb_ptr->sub_list_ptr != 320 ins->the_null_scb)) 321 return NULL; 322 323 scb->parent_scb_ptr->sub_list_ptr = scb; 324 } else { 325 snd_BUG(); 326 } 327 328 spin_lock_irqsave(&chip->reg_lock, flags); 329 330 /* update entry in DSP RAM */ 331 cs46xx_dsp_spos_update_scb(chip,scb->parent_scb_ptr); 332 333 spin_unlock_irqrestore(&chip->reg_lock, flags); 334 } 335 336 337 cs46xx_dsp_proc_register_scb_desc (chip,scb); 338 339 return scb; 340 } 341 342 static struct dsp_scb_descriptor * 343 cs46xx_dsp_create_generic_scb (struct snd_cs46xx *chip, char * name, u32 * scb_data, 344 u32 dest, char * task_entry_name, 345 struct dsp_scb_descriptor * parent_scb, 346 int scb_child_type) 347 { 348 struct dsp_symbol_entry * task_entry; 349 350 task_entry = cs46xx_dsp_lookup_symbol (chip,task_entry_name, 351 SYMBOL_CODE); 352 353 if (task_entry == NULL) { 354 dev_err(chip->card->dev, 355 "dsp_spos: symbol %s not found\n", task_entry_name); 356 return NULL; 357 } 358 359 return _dsp_create_generic_scb (chip,name,scb_data,dest,task_entry, 360 parent_scb,scb_child_type); 361 } 362 363 struct dsp_scb_descriptor * 364 cs46xx_dsp_create_timing_master_scb (struct snd_cs46xx *chip) 365 { 366 struct dsp_scb_descriptor * scb; 367 368 struct dsp_timing_master_scb timing_master_scb = { 369 { 0, 370 0, 371 0, 372 0 373 }, 374 { 0, 375 0, 376 0, 377 0, 378 0 379 }, 380 0,0, 381 0,NULL_SCB_ADDR, 382 0,0, /* extraSampleAccum:TMreserved */ 383 0,0, /* codecFIFOptr:codecFIFOsyncd */ 384 0x0001,0x8000, /* fracSampAccumQm1:TMfrmsLeftInGroup */ 385 0x0001,0x0000, /* fracSampCorrectionQm1:TMfrmGroupLength */ 386 0x00060000 /* nSampPerFrmQ15 */ 387 }; 388 389 scb = cs46xx_dsp_create_generic_scb(chip,"TimingMasterSCBInst",(u32 *)&timing_master_scb, 390 TIMINGMASTER_SCB_ADDR, 391 "TIMINGMASTER",NULL,SCB_NO_PARENT); 392 393 return scb; 394 } 395 396 397 struct dsp_scb_descriptor * 398 cs46xx_dsp_create_codec_out_scb(struct snd_cs46xx * chip, char * codec_name, 399 u16 channel_disp, u16 fifo_addr, u16 child_scb_addr, 400 u32 dest, struct dsp_scb_descriptor * parent_scb, 401 int scb_child_type) 402 { 403 struct dsp_scb_descriptor * scb; 404 405 struct dsp_codec_output_scb codec_out_scb = { 406 { 0, 407 0, 408 0, 409 0 410 }, 411 { 412 0, 413 0, 414 0, 415 0, 416 0 417 }, 418 0,0, 419 0,NULL_SCB_ADDR, 420 0, /* COstrmRsConfig */ 421 0, /* COstrmBufPtr */ 422 channel_disp,fifo_addr, /* leftChanBaseIOaddr:rightChanIOdisp */ 423 0x0000,0x0080, /* (!AC97!) COexpVolChangeRate:COscaleShiftCount */ 424 0,child_scb_addr /* COreserved - need child scb to work with rom code */ 425 }; 426 427 428 scb = cs46xx_dsp_create_generic_scb(chip,codec_name,(u32 *)&codec_out_scb, 429 dest,"S16_CODECOUTPUTTASK",parent_scb, 430 scb_child_type); 431 432 return scb; 433 } 434 435 struct dsp_scb_descriptor * 436 cs46xx_dsp_create_codec_in_scb(struct snd_cs46xx * chip, char * codec_name, 437 u16 channel_disp, u16 fifo_addr, u16 sample_buffer_addr, 438 u32 dest, struct dsp_scb_descriptor * parent_scb, 439 int scb_child_type) 440 { 441 442 struct dsp_scb_descriptor * scb; 443 struct dsp_codec_input_scb codec_input_scb = { 444 { 0, 445 0, 446 0, 447 0 448 }, 449 { 450 0, 451 0, 452 0, 453 0, 454 0 455 }, 456 457 #if 0 /* cs4620 */ 458 SyncIOSCB,NULL_SCB_ADDR 459 #else 460 0 , 0, 461 #endif 462 0,0, 463 464 RSCONFIG_SAMPLE_16STEREO + RSCONFIG_MODULO_64, /* strmRsConfig */ 465 sample_buffer_addr << 0x10, /* strmBufPtr; defined as a dword ptr, used as a byte ptr */ 466 channel_disp,fifo_addr, /* (!AC97!) leftChanBaseINaddr=AC97primary 467 link input slot 3 :rightChanINdisp=""slot 4 */ 468 0x0000,0x0000, /* (!AC97!) ????:scaleShiftCount; no shift needed 469 because AC97 is already 20 bits */ 470 0x80008000 /* ??clw cwcgame.scb has 0 */ 471 }; 472 473 scb = cs46xx_dsp_create_generic_scb(chip,codec_name,(u32 *)&codec_input_scb, 474 dest,"S16_CODECINPUTTASK",parent_scb, 475 scb_child_type); 476 return scb; 477 } 478 479 480 static struct dsp_scb_descriptor * 481 cs46xx_dsp_create_pcm_reader_scb(struct snd_cs46xx * chip, char * scb_name, 482 u16 sample_buffer_addr, u32 dest, 483 int virtual_channel, u32 playback_hw_addr, 484 struct dsp_scb_descriptor * parent_scb, 485 int scb_child_type) 486 { 487 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 488 struct dsp_scb_descriptor * scb; 489 490 struct dsp_generic_scb pcm_reader_scb = { 491 492 /* 493 Play DMA Task xfers data from host buffer to SP buffer 494 init/runtime variables: 495 PlayAC: Play Audio Data Conversion - SCB loc: 2nd dword, mask: 0x0000F000L 496 DATA_FMT_16BIT_ST_LTLEND(0x00000000L) from 16-bit stereo, little-endian 497 DATA_FMT_8_BIT_ST_SIGNED(0x00001000L) from 8-bit stereo, signed 498 DATA_FMT_16BIT_MN_LTLEND(0x00002000L) from 16-bit mono, little-endian 499 DATA_FMT_8_BIT_MN_SIGNED(0x00003000L) from 8-bit mono, signed 500 DATA_FMT_16BIT_ST_BIGEND(0x00004000L) from 16-bit stereo, big-endian 501 DATA_FMT_16BIT_MN_BIGEND(0x00006000L) from 16-bit mono, big-endian 502 DATA_FMT_8_BIT_ST_UNSIGNED(0x00009000L) from 8-bit stereo, unsigned 503 DATA_FMT_8_BIT_MN_UNSIGNED(0x0000b000L) from 8-bit mono, unsigned 504 ? Other combinations possible from: 505 DMA_RQ_C2_AUDIO_CONVERT_MASK 0x0000F000L 506 DMA_RQ_C2_AC_NONE 0x00000000L 507 DMA_RQ_C2_AC_8_TO_16_BIT 0x00001000L 508 DMA_RQ_C2_AC_MONO_TO_STEREO 0x00002000L 509 DMA_RQ_C2_AC_ENDIAN_CONVERT 0x00004000L 510 DMA_RQ_C2_AC_SIGNED_CONVERT 0x00008000L 511 512 HostBuffAddr: Host Buffer Physical Byte Address - SCB loc:3rd dword, Mask: 0xFFFFFFFFL 513 aligned to dword boundary 514 */ 515 /* Basic (non scatter/gather) DMA requestor (4 ints) */ 516 { DMA_RQ_C1_SOURCE_ON_HOST + /* source buffer is on the host */ 517 DMA_RQ_C1_SOURCE_MOD1024 + /* source buffer is 1024 dwords (4096 bytes) */ 518 DMA_RQ_C1_DEST_MOD32 + /* dest buffer(PCMreaderBuf) is 32 dwords*/ 519 DMA_RQ_C1_WRITEBACK_SRC_FLAG + /* ?? */ 520 DMA_RQ_C1_WRITEBACK_DEST_FLAG + /* ?? */ 521 15, /* DwordCount-1: picked 16 for DwordCount because Jim */ 522 /* Barnette said that is what we should use since */ 523 /* we are not running in optimized mode? */ 524 DMA_RQ_C2_AC_NONE + 525 DMA_RQ_C2_SIGNAL_SOURCE_PINGPONG + /* set play interrupt (bit0) in HISR when source */ 526 /* buffer (on host) crosses half-way point */ 527 virtual_channel, /* Play DMA channel arbitrarily set to 0 */ 528 playback_hw_addr, /* HostBuffAddr (source) */ 529 DMA_RQ_SD_SP_SAMPLE_ADDR + /* destination buffer is in SP Sample Memory */ 530 sample_buffer_addr /* SP Buffer Address (destination) */ 531 }, 532 /* Scatter/gather DMA requestor extension (5 ints) */ 533 { 534 0, 535 0, 536 0, 537 0, 538 0 539 }, 540 /* Sublist pointer & next stream control block (SCB) link. */ 541 NULL_SCB_ADDR,NULL_SCB_ADDR, 542 /* Pointer to this tasks parameter block & stream function pointer */ 543 0,NULL_SCB_ADDR, 544 /* rsConfig register for stream buffer (rsDMA reg. is loaded from basicReq.daw */ 545 /* for incoming streams, or basicReq.saw, for outgoing streams) */ 546 RSCONFIG_DMA_ENABLE + /* enable DMA */ 547 (19 << RSCONFIG_MAX_DMA_SIZE_SHIFT) + /* MAX_DMA_SIZE picked to be 19 since SPUD */ 548 /* uses it for some reason */ 549 ((dest >> 4) << RSCONFIG_STREAM_NUM_SHIFT) + /* stream number = SCBaddr/16 */ 550 RSCONFIG_SAMPLE_16STEREO + 551 RSCONFIG_MODULO_32, /* dest buffer(PCMreaderBuf) is 32 dwords (256 bytes) */ 552 /* Stream sample pointer & MAC-unit mode for this stream */ 553 (sample_buffer_addr << 0x10), 554 /* Fractional increment per output sample in the input sample buffer */ 555 0, 556 { 557 /* Standard stereo volume control 558 default muted */ 559 0xffff,0xffff, 560 0xffff,0xffff 561 } 562 }; 563 564 if (ins->null_algorithm == NULL) { 565 ins->null_algorithm = cs46xx_dsp_lookup_symbol (chip,"NULLALGORITHM", 566 SYMBOL_CODE); 567 568 if (ins->null_algorithm == NULL) { 569 dev_err(chip->card->dev, 570 "dsp_spos: symbol NULLALGORITHM not found\n"); 571 return NULL; 572 } 573 } 574 575 scb = _dsp_create_generic_scb(chip,scb_name,(u32 *)&pcm_reader_scb, 576 dest,ins->null_algorithm,parent_scb, 577 scb_child_type); 578 579 return scb; 580 } 581 582 #define GOF_PER_SEC 200 583 584 struct dsp_scb_descriptor * 585 cs46xx_dsp_create_src_task_scb(struct snd_cs46xx * chip, char * scb_name, 586 int rate, 587 u16 src_buffer_addr, 588 u16 src_delay_buffer_addr, u32 dest, 589 struct dsp_scb_descriptor * parent_scb, 590 int scb_child_type, 591 int pass_through) 592 { 593 594 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 595 struct dsp_scb_descriptor * scb; 596 unsigned int tmp1, tmp2; 597 unsigned int phiIncr; 598 unsigned int correctionPerGOF, correctionPerSec; 599 600 dev_dbg(chip->card->dev, "dsp_spos: setting %s rate to %u\n", 601 scb_name, rate); 602 603 /* 604 * Compute the values used to drive the actual sample rate conversion. 605 * The following formulas are being computed, using inline assembly 606 * since we need to use 64 bit arithmetic to compute the values: 607 * 608 * phiIncr = floor((Fs,in * 2^26) / Fs,out) 609 * correctionPerGOF = floor((Fs,in * 2^26 - Fs,out * phiIncr) / 610 * GOF_PER_SEC) 611 * ulCorrectionPerSec = Fs,in * 2^26 - Fs,out * phiIncr -M 612 * GOF_PER_SEC * correctionPerGOF 613 * 614 * i.e. 615 * 616 * phiIncr:other = dividend:remainder((Fs,in * 2^26) / Fs,out) 617 * correctionPerGOF:correctionPerSec = 618 * dividend:remainder(ulOther / GOF_PER_SEC) 619 */ 620 tmp1 = rate << 16; 621 phiIncr = tmp1 / 48000; 622 tmp1 -= phiIncr * 48000; 623 tmp1 <<= 10; 624 phiIncr <<= 10; 625 tmp2 = tmp1 / 48000; 626 phiIncr += tmp2; 627 tmp1 -= tmp2 * 48000; 628 correctionPerGOF = tmp1 / GOF_PER_SEC; 629 tmp1 -= correctionPerGOF * GOF_PER_SEC; 630 correctionPerSec = tmp1; 631 632 { 633 struct dsp_src_task_scb src_task_scb = { 634 0x0028,0x00c8, 635 0x5555,0x0000, 636 0x0000,0x0000, 637 src_buffer_addr,1, 638 correctionPerGOF,correctionPerSec, 639 RSCONFIG_SAMPLE_16STEREO + RSCONFIG_MODULO_32, 640 0x0000,src_delay_buffer_addr, 641 0x0, 642 0x080,(src_delay_buffer_addr + (24 * 4)), 643 0,0, /* next_scb, sub_list_ptr */ 644 0,0, /* entry, this_spb */ 645 RSCONFIG_SAMPLE_16STEREO + RSCONFIG_MODULO_8, 646 src_buffer_addr << 0x10, 647 phiIncr, 648 { 649 0xffff - ins->dac_volume_right,0xffff - ins->dac_volume_left, 650 0xffff - ins->dac_volume_right,0xffff - ins->dac_volume_left 651 } 652 }; 653 654 if (ins->s16_up == NULL) { 655 ins->s16_up = cs46xx_dsp_lookup_symbol (chip,"S16_UPSRC", 656 SYMBOL_CODE); 657 658 if (ins->s16_up == NULL) { 659 dev_err(chip->card->dev, 660 "dsp_spos: symbol S16_UPSRC not found\n"); 661 return NULL; 662 } 663 } 664 665 /* clear buffers */ 666 _dsp_clear_sample_buffer (chip,src_buffer_addr,8); 667 _dsp_clear_sample_buffer (chip,src_delay_buffer_addr,32); 668 669 if (pass_through) { 670 /* wont work with any other rate than 671 the native DSP rate */ 672 snd_BUG_ON(rate != 48000); 673 674 scb = cs46xx_dsp_create_generic_scb(chip,scb_name,(u32 *)&src_task_scb, 675 dest,"DMAREADER",parent_scb, 676 scb_child_type); 677 } else { 678 scb = _dsp_create_generic_scb(chip,scb_name,(u32 *)&src_task_scb, 679 dest,ins->s16_up,parent_scb, 680 scb_child_type); 681 } 682 683 684 } 685 686 return scb; 687 } 688 689 #if 0 /* not used */ 690 struct dsp_scb_descriptor * 691 cs46xx_dsp_create_filter_scb(struct snd_cs46xx * chip, char * scb_name, 692 u16 buffer_addr, u32 dest, 693 struct dsp_scb_descriptor * parent_scb, 694 int scb_child_type) { 695 struct dsp_scb_descriptor * scb; 696 697 struct dsp_filter_scb filter_scb = { 698 .a0_right = 0x41a9, 699 .a0_left = 0x41a9, 700 .a1_right = 0xb8e4, 701 .a1_left = 0xb8e4, 702 .a2_right = 0x3e55, 703 .a2_left = 0x3e55, 704 705 .filter_unused3 = 0x0000, 706 .filter_unused2 = 0x0000, 707 708 .output_buf_ptr = buffer_addr, 709 .init = 0x000, 710 711 .prev_sample_output1 = 0x00000000, 712 .prev_sample_output2 = 0x00000000, 713 714 .prev_sample_input1 = 0x00000000, 715 .prev_sample_input2 = 0x00000000, 716 717 .next_scb_ptr = 0x0000, 718 .sub_list_ptr = 0x0000, 719 720 .entry_point = 0x0000, 721 .spb_ptr = 0x0000, 722 723 .b0_right = 0x0e38, 724 .b0_left = 0x0e38, 725 .b1_right = 0x1c71, 726 .b1_left = 0x1c71, 727 .b2_right = 0x0e38, 728 .b2_left = 0x0e38, 729 }; 730 731 732 scb = cs46xx_dsp_create_generic_scb(chip,scb_name,(u32 *)&filter_scb, 733 dest,"FILTERTASK",parent_scb, 734 scb_child_type); 735 736 return scb; 737 } 738 #endif /* not used */ 739 740 struct dsp_scb_descriptor * 741 cs46xx_dsp_create_mix_only_scb(struct snd_cs46xx * chip, char * scb_name, 742 u16 mix_buffer_addr, u32 dest, 743 struct dsp_scb_descriptor * parent_scb, 744 int scb_child_type) 745 { 746 struct dsp_scb_descriptor * scb; 747 748 struct dsp_mix_only_scb master_mix_scb = { 749 /* 0 */ { 0, 750 /* 1 */ 0, 751 /* 2 */ mix_buffer_addr, 752 /* 3 */ 0 753 /* */ }, 754 { 755 /* 4 */ 0, 756 /* 5 */ 0, 757 /* 6 */ 0, 758 /* 7 */ 0, 759 /* 8 */ 0x00000080 760 }, 761 /* 9 */ 0,0, 762 /* A */ 0,0, 763 /* B */ RSCONFIG_SAMPLE_16STEREO + RSCONFIG_MODULO_32, 764 /* C */ (mix_buffer_addr + (16 * 4)) << 0x10, 765 /* D */ 0, 766 { 767 /* E */ 0x8000,0x8000, 768 /* F */ 0x8000,0x8000 769 } 770 }; 771 772 773 scb = cs46xx_dsp_create_generic_scb(chip,scb_name,(u32 *)&master_mix_scb, 774 dest,"S16_MIX",parent_scb, 775 scb_child_type); 776 return scb; 777 } 778 779 780 struct dsp_scb_descriptor * 781 cs46xx_dsp_create_mix_to_ostream_scb(struct snd_cs46xx * chip, char * scb_name, 782 u16 mix_buffer_addr, u16 writeback_spb, u32 dest, 783 struct dsp_scb_descriptor * parent_scb, 784 int scb_child_type) 785 { 786 struct dsp_scb_descriptor * scb; 787 788 struct dsp_mix2_ostream_scb mix2_ostream_scb = { 789 /* Basic (non scatter/gather) DMA requestor (4 ints) */ 790 { 791 DMA_RQ_C1_SOURCE_MOD64 + 792 DMA_RQ_C1_DEST_ON_HOST + 793 DMA_RQ_C1_DEST_MOD1024 + 794 DMA_RQ_C1_WRITEBACK_SRC_FLAG + 795 DMA_RQ_C1_WRITEBACK_DEST_FLAG + 796 15, 797 798 DMA_RQ_C2_AC_NONE + 799 DMA_RQ_C2_SIGNAL_DEST_PINGPONG + 800 801 CS46XX_DSP_CAPTURE_CHANNEL, 802 DMA_RQ_SD_SP_SAMPLE_ADDR + 803 mix_buffer_addr, 804 0x0 805 }, 806 807 { 0, 0, 0, 0, 0, }, 808 0,0, 809 0,writeback_spb, 810 811 RSCONFIG_DMA_ENABLE + 812 (19 << RSCONFIG_MAX_DMA_SIZE_SHIFT) + 813 814 ((dest >> 4) << RSCONFIG_STREAM_NUM_SHIFT) + 815 RSCONFIG_DMA_TO_HOST + 816 RSCONFIG_SAMPLE_16STEREO + 817 RSCONFIG_MODULO_64, 818 (mix_buffer_addr + (32 * 4)) << 0x10, 819 1,0, 820 0x0001,0x0080, 821 0xFFFF,0 822 }; 823 824 825 scb = cs46xx_dsp_create_generic_scb(chip,scb_name,(u32 *)&mix2_ostream_scb, 826 827 dest,"S16_MIX_TO_OSTREAM",parent_scb, 828 scb_child_type); 829 830 return scb; 831 } 832 833 834 struct dsp_scb_descriptor * 835 cs46xx_dsp_create_vari_decimate_scb(struct snd_cs46xx * chip,char * scb_name, 836 u16 vari_buffer_addr0, 837 u16 vari_buffer_addr1, 838 u32 dest, 839 struct dsp_scb_descriptor * parent_scb, 840 int scb_child_type) 841 { 842 843 struct dsp_scb_descriptor * scb; 844 845 struct dsp_vari_decimate_scb vari_decimate_scb = { 846 0x0028,0x00c8, 847 0x5555,0x0000, 848 0x0000,0x0000, 849 vari_buffer_addr0,vari_buffer_addr1, 850 851 0x0028,0x00c8, 852 RSCONFIG_SAMPLE_16STEREO + RSCONFIG_MODULO_256, 853 854 0xFF800000, 855 0, 856 0x0080,vari_buffer_addr1 + (25 * 4), 857 858 0,0, 859 0,0, 860 861 RSCONFIG_SAMPLE_16STEREO + RSCONFIG_MODULO_8, 862 vari_buffer_addr0 << 0x10, 863 0x04000000, 864 { 865 0x8000,0x8000, 866 0xFFFF,0xFFFF 867 } 868 }; 869 870 scb = cs46xx_dsp_create_generic_scb(chip,scb_name,(u32 *)&vari_decimate_scb, 871 dest,"VARIDECIMATE",parent_scb, 872 scb_child_type); 873 874 return scb; 875 } 876 877 878 static struct dsp_scb_descriptor * 879 cs46xx_dsp_create_pcm_serial_input_scb(struct snd_cs46xx * chip, char * scb_name, u32 dest, 880 struct dsp_scb_descriptor * input_scb, 881 struct dsp_scb_descriptor * parent_scb, 882 int scb_child_type) 883 { 884 885 struct dsp_scb_descriptor * scb; 886 887 888 struct dsp_pcm_serial_input_scb pcm_serial_input_scb = { 889 { 0, 890 0, 891 0, 892 0 893 }, 894 { 895 0, 896 0, 897 0, 898 0, 899 0 900 }, 901 902 0,0, 903 0,0, 904 905 RSCONFIG_SAMPLE_16STEREO + RSCONFIG_MODULO_16, 906 0, 907 /* 0xD */ 0,input_scb->address, 908 { 909 /* 0xE */ 0x8000,0x8000, 910 /* 0xF */ 0x8000,0x8000 911 } 912 }; 913 914 scb = cs46xx_dsp_create_generic_scb(chip,scb_name,(u32 *)&pcm_serial_input_scb, 915 dest,"PCMSERIALINPUTTASK",parent_scb, 916 scb_child_type); 917 return scb; 918 } 919 920 921 static struct dsp_scb_descriptor * 922 cs46xx_dsp_create_asynch_fg_tx_scb(struct snd_cs46xx * chip, char * scb_name, u32 dest, 923 u16 hfg_scb_address, 924 u16 asynch_buffer_address, 925 struct dsp_scb_descriptor * parent_scb, 926 int scb_child_type) 927 { 928 929 struct dsp_scb_descriptor * scb; 930 931 struct dsp_asynch_fg_tx_scb asynch_fg_tx_scb = { 932 0xfc00,0x03ff, /* Prototype sample buffer size of 256 dwords */ 933 0x0058,0x0028, /* Min Delta 7 dwords == 28 bytes */ 934 /* : Max delta 25 dwords == 100 bytes */ 935 0,hfg_scb_address, /* Point to HFG task SCB */ 936 0,0, /* Initialize current Delta and Consumer ptr adjustment count */ 937 0, /* Initialize accumulated Phi to 0 */ 938 0,0x2aab, /* Const 1/3 */ 939 940 { 941 0, /* Define the unused elements */ 942 0, 943 0 944 }, 945 946 0,0, 947 0,dest + AFGTxAccumPhi, 948 949 RSCONFIG_SAMPLE_16STEREO + RSCONFIG_MODULO_256, /* Stereo, 256 dword */ 950 (asynch_buffer_address) << 0x10, /* This should be automagically synchronized 951 to the producer pointer */ 952 953 /* There is no correct initial value, it will depend upon the detected 954 rate etc */ 955 0x18000000, /* Phi increment for approx 32k operation */ 956 0x8000,0x8000, /* Volume controls are unused at this time */ 957 0x8000,0x8000 958 }; 959 960 scb = cs46xx_dsp_create_generic_scb(chip,scb_name,(u32 *)&asynch_fg_tx_scb, 961 dest,"ASYNCHFGTXCODE",parent_scb, 962 scb_child_type); 963 964 return scb; 965 } 966 967 968 struct dsp_scb_descriptor * 969 cs46xx_dsp_create_asynch_fg_rx_scb(struct snd_cs46xx * chip, char * scb_name, u32 dest, 970 u16 hfg_scb_address, 971 u16 asynch_buffer_address, 972 struct dsp_scb_descriptor * parent_scb, 973 int scb_child_type) 974 { 975 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 976 struct dsp_scb_descriptor * scb; 977 978 struct dsp_asynch_fg_rx_scb asynch_fg_rx_scb = { 979 0xfe00,0x01ff, /* Prototype sample buffer size of 128 dwords */ 980 0x0064,0x001c, /* Min Delta 7 dwords == 28 bytes */ 981 /* : Max delta 25 dwords == 100 bytes */ 982 0,hfg_scb_address, /* Point to HFG task SCB */ 983 0,0, /* Initialize current Delta and Consumer ptr adjustment count */ 984 { 985 0, /* Define the unused elements */ 986 0, 987 0, 988 0, 989 0 990 }, 991 992 0,0, 993 0,dest, 994 995 RSCONFIG_MODULO_128 | 996 RSCONFIG_SAMPLE_16STEREO, /* Stereo, 128 dword */ 997 ( (asynch_buffer_address + (16 * 4)) << 0x10), /* This should be automagically 998 synchrinized to the producer pointer */ 999 1000 /* There is no correct initial value, it will depend upon the detected 1001 rate etc */ 1002 0x18000000, 1003 1004 /* Set IEC958 input volume */ 1005 0xffff - ins->spdif_input_volume_right,0xffff - ins->spdif_input_volume_left, 1006 0xffff - ins->spdif_input_volume_right,0xffff - ins->spdif_input_volume_left, 1007 }; 1008 1009 scb = cs46xx_dsp_create_generic_scb(chip,scb_name,(u32 *)&asynch_fg_rx_scb, 1010 dest,"ASYNCHFGRXCODE",parent_scb, 1011 scb_child_type); 1012 1013 return scb; 1014 } 1015 1016 1017 #if 0 /* not used */ 1018 struct dsp_scb_descriptor * 1019 cs46xx_dsp_create_output_snoop_scb(struct snd_cs46xx * chip, char * scb_name, u32 dest, 1020 u16 snoop_buffer_address, 1021 struct dsp_scb_descriptor * snoop_scb, 1022 struct dsp_scb_descriptor * parent_scb, 1023 int scb_child_type) 1024 { 1025 1026 struct dsp_scb_descriptor * scb; 1027 1028 struct dsp_output_snoop_scb output_snoop_scb = { 1029 { 0, /* not used. Zero */ 1030 0, 1031 0, 1032 0, 1033 }, 1034 { 1035 0, /* not used. Zero */ 1036 0, 1037 0, 1038 0, 1039 0 1040 }, 1041 1042 0,0, 1043 0,0, 1044 1045 RSCONFIG_SAMPLE_16STEREO + RSCONFIG_MODULO_64, 1046 snoop_buffer_address << 0x10, 1047 0,0, 1048 0, 1049 0,snoop_scb->address 1050 }; 1051 1052 scb = cs46xx_dsp_create_generic_scb(chip,scb_name,(u32 *)&output_snoop_scb, 1053 dest,"OUTPUTSNOOP",parent_scb, 1054 scb_child_type); 1055 return scb; 1056 } 1057 #endif /* not used */ 1058 1059 1060 struct dsp_scb_descriptor * 1061 cs46xx_dsp_create_spio_write_scb(struct snd_cs46xx * chip, char * scb_name, u32 dest, 1062 struct dsp_scb_descriptor * parent_scb, 1063 int scb_child_type) 1064 { 1065 struct dsp_scb_descriptor * scb; 1066 1067 struct dsp_spio_write_scb spio_write_scb = { 1068 0,0, /* SPIOWAddress2:SPIOWAddress1; */ 1069 0, /* SPIOWData1; */ 1070 0, /* SPIOWData2; */ 1071 0,0, /* SPIOWAddress4:SPIOWAddress3; */ 1072 0, /* SPIOWData3; */ 1073 0, /* SPIOWData4; */ 1074 0,0, /* SPIOWDataPtr:Unused1; */ 1075 { 0,0 }, /* Unused2[2]; */ 1076 1077 0,0, /* SPIOWChildPtr:SPIOWSiblingPtr; */ 1078 0,0, /* SPIOWThisPtr:SPIOWEntryPoint; */ 1079 1080 { 1081 0, 1082 0, 1083 0, 1084 0, 1085 0 /* Unused3[5]; */ 1086 } 1087 }; 1088 1089 scb = cs46xx_dsp_create_generic_scb(chip,scb_name,(u32 *)&spio_write_scb, 1090 dest,"SPIOWRITE",parent_scb, 1091 scb_child_type); 1092 1093 return scb; 1094 } 1095 1096 struct dsp_scb_descriptor * 1097 cs46xx_dsp_create_magic_snoop_scb(struct snd_cs46xx * chip, char * scb_name, u32 dest, 1098 u16 snoop_buffer_address, 1099 struct dsp_scb_descriptor * snoop_scb, 1100 struct dsp_scb_descriptor * parent_scb, 1101 int scb_child_type) 1102 { 1103 struct dsp_scb_descriptor * scb; 1104 1105 struct dsp_magic_snoop_task magic_snoop_scb = { 1106 /* 0 */ 0, /* i0 */ 1107 /* 1 */ 0, /* i1 */ 1108 /* 2 */ snoop_buffer_address << 0x10, 1109 /* 3 */ 0,snoop_scb->address, 1110 /* 4 */ 0, /* i3 */ 1111 /* 5 */ 0, /* i4 */ 1112 /* 6 */ 0, /* i5 */ 1113 /* 7 */ 0, /* i6 */ 1114 /* 8 */ 0, /* i7 */ 1115 /* 9 */ 0,0, /* next_scb, sub_list_ptr */ 1116 /* A */ 0,0, /* entry_point, this_ptr */ 1117 /* B */ RSCONFIG_SAMPLE_16STEREO + RSCONFIG_MODULO_64, 1118 /* C */ snoop_buffer_address << 0x10, 1119 /* D */ 0, 1120 /* E */ { 0x8000,0x8000, 1121 /* F */ 0xffff,0xffff 1122 } 1123 }; 1124 1125 scb = cs46xx_dsp_create_generic_scb(chip,scb_name,(u32 *)&magic_snoop_scb, 1126 dest,"MAGICSNOOPTASK",parent_scb, 1127 scb_child_type); 1128 1129 return scb; 1130 } 1131 1132 static struct dsp_scb_descriptor * 1133 find_next_free_scb (struct snd_cs46xx * chip, struct dsp_scb_descriptor * from) 1134 { 1135 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 1136 struct dsp_scb_descriptor * scb = from; 1137 1138 while (scb->next_scb_ptr != ins->the_null_scb) { 1139 if (snd_BUG_ON(!scb->next_scb_ptr)) 1140 return NULL; 1141 1142 scb = scb->next_scb_ptr; 1143 } 1144 1145 return scb; 1146 } 1147 1148 static u32 pcm_reader_buffer_addr[DSP_MAX_PCM_CHANNELS] = { 1149 0x0600, /* 1 */ 1150 0x1500, /* 2 */ 1151 0x1580, /* 3 */ 1152 0x1600, /* 4 */ 1153 0x1680, /* 5 */ 1154 0x1700, /* 6 */ 1155 0x1780, /* 7 */ 1156 0x1800, /* 8 */ 1157 0x1880, /* 9 */ 1158 0x1900, /* 10 */ 1159 0x1980, /* 11 */ 1160 0x1A00, /* 12 */ 1161 0x1A80, /* 13 */ 1162 0x1B00, /* 14 */ 1163 0x1B80, /* 15 */ 1164 0x1C00, /* 16 */ 1165 0x1C80, /* 17 */ 1166 0x1D00, /* 18 */ 1167 0x1D80, /* 19 */ 1168 0x1E00, /* 20 */ 1169 0x1E80, /* 21 */ 1170 0x1F00, /* 22 */ 1171 0x1F80, /* 23 */ 1172 0x2000, /* 24 */ 1173 0x2080, /* 25 */ 1174 0x2100, /* 26 */ 1175 0x2180, /* 27 */ 1176 0x2200, /* 28 */ 1177 0x2280, /* 29 */ 1178 0x2300, /* 30 */ 1179 0x2380, /* 31 */ 1180 0x2400, /* 32 */ 1181 }; 1182 1183 static u32 src_output_buffer_addr[DSP_MAX_SRC_NR] = { 1184 0x2B80, 1185 0x2BA0, 1186 0x2BC0, 1187 0x2BE0, 1188 0x2D00, 1189 0x2D20, 1190 0x2D40, 1191 0x2D60, 1192 0x2D80, 1193 0x2DA0, 1194 0x2DC0, 1195 0x2DE0, 1196 0x2E00, 1197 0x2E20 1198 }; 1199 1200 static u32 src_delay_buffer_addr[DSP_MAX_SRC_NR] = { 1201 0x2480, 1202 0x2500, 1203 0x2580, 1204 0x2600, 1205 0x2680, 1206 0x2700, 1207 0x2780, 1208 0x2800, 1209 0x2880, 1210 0x2900, 1211 0x2980, 1212 0x2A00, 1213 0x2A80, 1214 0x2B00 1215 }; 1216 1217 struct dsp_pcm_channel_descriptor * 1218 cs46xx_dsp_create_pcm_channel (struct snd_cs46xx * chip, 1219 u32 sample_rate, void * private_data, 1220 u32 hw_dma_addr, 1221 int pcm_channel_id) 1222 { 1223 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 1224 struct dsp_scb_descriptor * src_scb = NULL, * pcm_scb, * mixer_scb = NULL; 1225 struct dsp_scb_descriptor * src_parent_scb = NULL; 1226 1227 /* struct dsp_scb_descriptor * pcm_parent_scb; */ 1228 char scb_name[DSP_MAX_SCB_NAME]; 1229 int i, pcm_index = -1, insert_point, src_index = -1, pass_through = 0; 1230 unsigned long flags; 1231 1232 switch (pcm_channel_id) { 1233 case DSP_PCM_MAIN_CHANNEL: 1234 mixer_scb = ins->master_mix_scb; 1235 break; 1236 case DSP_PCM_REAR_CHANNEL: 1237 mixer_scb = ins->rear_mix_scb; 1238 break; 1239 case DSP_PCM_CENTER_LFE_CHANNEL: 1240 mixer_scb = ins->center_lfe_mix_scb; 1241 break; 1242 case DSP_PCM_S71_CHANNEL: 1243 /* TODO */ 1244 snd_BUG(); 1245 break; 1246 case DSP_IEC958_CHANNEL: 1247 if (snd_BUG_ON(!ins->asynch_tx_scb)) 1248 return NULL; 1249 mixer_scb = ins->asynch_tx_scb; 1250 1251 /* if sample rate is set to 48khz we pass 1252 the Sample Rate Converted (which could 1253 alter the raw data stream ...) */ 1254 if (sample_rate == 48000) { 1255 dev_dbg(chip->card->dev, "IEC958 pass through\n"); 1256 /* Hack to bypass creating a new SRC */ 1257 pass_through = 1; 1258 } 1259 break; 1260 default: 1261 snd_BUG(); 1262 return NULL; 1263 } 1264 /* default sample rate is 44100 */ 1265 if (!sample_rate) sample_rate = 44100; 1266 1267 /* search for a already created SRC SCB with the same sample rate */ 1268 for (i = 0; i < DSP_MAX_PCM_CHANNELS && 1269 (pcm_index == -1 || src_scb == NULL); ++i) { 1270 1271 /* virtual channel reserved 1272 for capture */ 1273 if (i == CS46XX_DSP_CAPTURE_CHANNEL) continue; 1274 1275 if (ins->pcm_channels[i].active) { 1276 if (!src_scb && 1277 ins->pcm_channels[i].sample_rate == sample_rate && 1278 ins->pcm_channels[i].mixer_scb == mixer_scb) { 1279 src_scb = ins->pcm_channels[i].src_scb; 1280 ins->pcm_channels[i].src_scb->ref_count ++; 1281 src_index = ins->pcm_channels[i].src_slot; 1282 } 1283 } else if (pcm_index == -1) { 1284 pcm_index = i; 1285 } 1286 } 1287 1288 if (pcm_index == -1) { 1289 dev_err(chip->card->dev, "dsp_spos: no free PCM channel\n"); 1290 return NULL; 1291 } 1292 1293 if (src_scb == NULL) { 1294 if (ins->nsrc_scb >= DSP_MAX_SRC_NR) { 1295 dev_err(chip->card->dev, 1296 "dsp_spos: to many SRC instances\n!"); 1297 return NULL; 1298 } 1299 1300 /* find a free slot */ 1301 for (i = 0; i < DSP_MAX_SRC_NR; ++i) { 1302 if (ins->src_scb_slots[i] == 0) { 1303 src_index = i; 1304 ins->src_scb_slots[i] = 1; 1305 break; 1306 } 1307 } 1308 if (snd_BUG_ON(src_index == -1)) 1309 return NULL; 1310 1311 /* we need to create a new SRC SCB */ 1312 if (mixer_scb->sub_list_ptr == ins->the_null_scb) { 1313 src_parent_scb = mixer_scb; 1314 insert_point = SCB_ON_PARENT_SUBLIST_SCB; 1315 } else { 1316 src_parent_scb = find_next_free_scb(chip,mixer_scb->sub_list_ptr); 1317 insert_point = SCB_ON_PARENT_NEXT_SCB; 1318 } 1319 1320 snprintf (scb_name,DSP_MAX_SCB_NAME,"SrcTask_SCB%d",src_index); 1321 1322 dev_dbg(chip->card->dev, 1323 "dsp_spos: creating SRC \"%s\"\n", scb_name); 1324 src_scb = cs46xx_dsp_create_src_task_scb(chip,scb_name, 1325 sample_rate, 1326 src_output_buffer_addr[src_index], 1327 src_delay_buffer_addr[src_index], 1328 /* 0x400 - 0x600 source SCBs */ 1329 0x400 + (src_index * 0x10) , 1330 src_parent_scb, 1331 insert_point, 1332 pass_through); 1333 1334 if (!src_scb) { 1335 dev_err(chip->card->dev, 1336 "dsp_spos: failed to create SRCtaskSCB\n"); 1337 return NULL; 1338 } 1339 1340 /* cs46xx_dsp_set_src_sample_rate(chip,src_scb,sample_rate); */ 1341 1342 ins->nsrc_scb ++; 1343 } 1344 1345 1346 snprintf (scb_name,DSP_MAX_SCB_NAME,"PCMReader_SCB%d",pcm_index); 1347 1348 dev_dbg(chip->card->dev, "dsp_spos: creating PCM \"%s\" (%d)\n", 1349 scb_name, pcm_channel_id); 1350 1351 pcm_scb = cs46xx_dsp_create_pcm_reader_scb(chip,scb_name, 1352 pcm_reader_buffer_addr[pcm_index], 1353 /* 0x200 - 400 PCMreader SCBs */ 1354 (pcm_index * 0x10) + 0x200, 1355 pcm_index, /* virtual channel 0-31 */ 1356 hw_dma_addr, /* pcm hw addr */ 1357 NULL, /* parent SCB ptr */ 1358 0 /* insert point */ 1359 ); 1360 1361 if (!pcm_scb) { 1362 dev_err(chip->card->dev, 1363 "dsp_spos: failed to create PCMreaderSCB\n"); 1364 return NULL; 1365 } 1366 1367 spin_lock_irqsave(&chip->reg_lock, flags); 1368 ins->pcm_channels[pcm_index].sample_rate = sample_rate; 1369 ins->pcm_channels[pcm_index].pcm_reader_scb = pcm_scb; 1370 ins->pcm_channels[pcm_index].src_scb = src_scb; 1371 ins->pcm_channels[pcm_index].unlinked = 1; 1372 ins->pcm_channels[pcm_index].private_data = private_data; 1373 ins->pcm_channels[pcm_index].src_slot = src_index; 1374 ins->pcm_channels[pcm_index].active = 1; 1375 ins->pcm_channels[pcm_index].pcm_slot = pcm_index; 1376 ins->pcm_channels[pcm_index].mixer_scb = mixer_scb; 1377 ins->npcm_channels ++; 1378 spin_unlock_irqrestore(&chip->reg_lock, flags); 1379 1380 return (ins->pcm_channels + pcm_index); 1381 } 1382 1383 int cs46xx_dsp_pcm_channel_set_period (struct snd_cs46xx * chip, 1384 struct dsp_pcm_channel_descriptor * pcm_channel, 1385 int period_size) 1386 { 1387 u32 temp = snd_cs46xx_peek (chip,pcm_channel->pcm_reader_scb->address << 2); 1388 temp &= ~DMA_RQ_C1_SOURCE_SIZE_MASK; 1389 1390 switch (period_size) { 1391 case 2048: 1392 temp |= DMA_RQ_C1_SOURCE_MOD1024; 1393 break; 1394 case 1024: 1395 temp |= DMA_RQ_C1_SOURCE_MOD512; 1396 break; 1397 case 512: 1398 temp |= DMA_RQ_C1_SOURCE_MOD256; 1399 break; 1400 case 256: 1401 temp |= DMA_RQ_C1_SOURCE_MOD128; 1402 break; 1403 case 128: 1404 temp |= DMA_RQ_C1_SOURCE_MOD64; 1405 break; 1406 case 64: 1407 temp |= DMA_RQ_C1_SOURCE_MOD32; 1408 break; 1409 case 32: 1410 temp |= DMA_RQ_C1_SOURCE_MOD16; 1411 break; 1412 default: 1413 dev_dbg(chip->card->dev, 1414 "period size (%d) not supported by HW\n", period_size); 1415 return -EINVAL; 1416 } 1417 1418 snd_cs46xx_poke (chip,pcm_channel->pcm_reader_scb->address << 2,temp); 1419 1420 return 0; 1421 } 1422 1423 int cs46xx_dsp_pcm_ostream_set_period (struct snd_cs46xx * chip, 1424 int period_size) 1425 { 1426 u32 temp = snd_cs46xx_peek (chip,WRITEBACK_SCB_ADDR << 2); 1427 temp &= ~DMA_RQ_C1_DEST_SIZE_MASK; 1428 1429 switch (period_size) { 1430 case 2048: 1431 temp |= DMA_RQ_C1_DEST_MOD1024; 1432 break; 1433 case 1024: 1434 temp |= DMA_RQ_C1_DEST_MOD512; 1435 break; 1436 case 512: 1437 temp |= DMA_RQ_C1_DEST_MOD256; 1438 break; 1439 case 256: 1440 temp |= DMA_RQ_C1_DEST_MOD128; 1441 break; 1442 case 128: 1443 temp |= DMA_RQ_C1_DEST_MOD64; 1444 break; 1445 case 64: 1446 temp |= DMA_RQ_C1_DEST_MOD32; 1447 break; 1448 case 32: 1449 temp |= DMA_RQ_C1_DEST_MOD16; 1450 break; 1451 default: 1452 dev_dbg(chip->card->dev, 1453 "period size (%d) not supported by HW\n", period_size); 1454 return -EINVAL; 1455 } 1456 1457 snd_cs46xx_poke (chip,WRITEBACK_SCB_ADDR << 2,temp); 1458 1459 return 0; 1460 } 1461 1462 void cs46xx_dsp_destroy_pcm_channel (struct snd_cs46xx * chip, 1463 struct dsp_pcm_channel_descriptor * pcm_channel) 1464 { 1465 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 1466 unsigned long flags; 1467 1468 if (snd_BUG_ON(!pcm_channel->active || 1469 ins->npcm_channels <= 0 || 1470 pcm_channel->src_scb->ref_count <= 0)) 1471 return; 1472 1473 spin_lock_irqsave(&chip->reg_lock, flags); 1474 pcm_channel->unlinked = 1; 1475 pcm_channel->active = 0; 1476 pcm_channel->private_data = NULL; 1477 pcm_channel->src_scb->ref_count --; 1478 ins->npcm_channels --; 1479 spin_unlock_irqrestore(&chip->reg_lock, flags); 1480 1481 cs46xx_dsp_remove_scb(chip,pcm_channel->pcm_reader_scb); 1482 1483 if (!pcm_channel->src_scb->ref_count) { 1484 cs46xx_dsp_remove_scb(chip,pcm_channel->src_scb); 1485 1486 if (snd_BUG_ON(pcm_channel->src_slot < 0 || 1487 pcm_channel->src_slot >= DSP_MAX_SRC_NR)) 1488 return; 1489 1490 ins->src_scb_slots[pcm_channel->src_slot] = 0; 1491 ins->nsrc_scb --; 1492 } 1493 } 1494 1495 int cs46xx_dsp_pcm_unlink (struct snd_cs46xx * chip, 1496 struct dsp_pcm_channel_descriptor * pcm_channel) 1497 { 1498 unsigned long flags; 1499 1500 if (snd_BUG_ON(!pcm_channel->active || 1501 chip->dsp_spos_instance->npcm_channels <= 0)) 1502 return -EIO; 1503 1504 spin_lock_irqsave(&chip->reg_lock, flags); 1505 if (pcm_channel->unlinked) { 1506 spin_unlock_irqrestore(&chip->reg_lock, flags); 1507 return -EIO; 1508 } 1509 1510 pcm_channel->unlinked = 1; 1511 1512 _dsp_unlink_scb (chip,pcm_channel->pcm_reader_scb); 1513 spin_unlock_irqrestore(&chip->reg_lock, flags); 1514 1515 return 0; 1516 } 1517 1518 int cs46xx_dsp_pcm_link (struct snd_cs46xx * chip, 1519 struct dsp_pcm_channel_descriptor * pcm_channel) 1520 { 1521 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 1522 struct dsp_scb_descriptor * parent_scb; 1523 struct dsp_scb_descriptor * src_scb = pcm_channel->src_scb; 1524 unsigned long flags; 1525 1526 spin_lock_irqsave(&chip->reg_lock, flags); 1527 1528 if (pcm_channel->unlinked == 0) { 1529 spin_unlock_irqrestore(&chip->reg_lock, flags); 1530 return -EIO; 1531 } 1532 1533 parent_scb = src_scb; 1534 1535 if (src_scb->sub_list_ptr != ins->the_null_scb) { 1536 src_scb->sub_list_ptr->parent_scb_ptr = pcm_channel->pcm_reader_scb; 1537 pcm_channel->pcm_reader_scb->next_scb_ptr = src_scb->sub_list_ptr; 1538 } 1539 1540 src_scb->sub_list_ptr = pcm_channel->pcm_reader_scb; 1541 1542 snd_BUG_ON(pcm_channel->pcm_reader_scb->parent_scb_ptr); 1543 pcm_channel->pcm_reader_scb->parent_scb_ptr = parent_scb; 1544 1545 /* update SCB entry in DSP RAM */ 1546 cs46xx_dsp_spos_update_scb(chip,pcm_channel->pcm_reader_scb); 1547 1548 /* update parent SCB entry */ 1549 cs46xx_dsp_spos_update_scb(chip,parent_scb); 1550 1551 pcm_channel->unlinked = 0; 1552 spin_unlock_irqrestore(&chip->reg_lock, flags); 1553 return 0; 1554 } 1555 1556 struct dsp_scb_descriptor * 1557 cs46xx_add_record_source (struct snd_cs46xx *chip, struct dsp_scb_descriptor * source, 1558 u16 addr, char * scb_name) 1559 { 1560 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 1561 struct dsp_scb_descriptor * parent; 1562 struct dsp_scb_descriptor * pcm_input; 1563 int insert_point; 1564 1565 if (snd_BUG_ON(!ins->record_mixer_scb)) 1566 return NULL; 1567 1568 if (ins->record_mixer_scb->sub_list_ptr != ins->the_null_scb) { 1569 parent = find_next_free_scb (chip,ins->record_mixer_scb->sub_list_ptr); 1570 insert_point = SCB_ON_PARENT_NEXT_SCB; 1571 } else { 1572 parent = ins->record_mixer_scb; 1573 insert_point = SCB_ON_PARENT_SUBLIST_SCB; 1574 } 1575 1576 pcm_input = cs46xx_dsp_create_pcm_serial_input_scb(chip,scb_name,addr, 1577 source, parent, 1578 insert_point); 1579 1580 return pcm_input; 1581 } 1582 1583 int cs46xx_src_unlink(struct snd_cs46xx *chip, struct dsp_scb_descriptor * src) 1584 { 1585 unsigned long flags; 1586 1587 if (snd_BUG_ON(!src->parent_scb_ptr)) 1588 return -EINVAL; 1589 1590 /* mute SCB */ 1591 cs46xx_dsp_scb_set_volume (chip,src,0,0); 1592 1593 spin_lock_irqsave(&chip->reg_lock, flags); 1594 _dsp_unlink_scb (chip,src); 1595 spin_unlock_irqrestore(&chip->reg_lock, flags); 1596 1597 return 0; 1598 } 1599 1600 int cs46xx_src_link(struct snd_cs46xx *chip, struct dsp_scb_descriptor * src) 1601 { 1602 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 1603 struct dsp_scb_descriptor * parent_scb; 1604 1605 if (snd_BUG_ON(src->parent_scb_ptr)) 1606 return -EINVAL; 1607 if (snd_BUG_ON(!ins->master_mix_scb)) 1608 return -EINVAL; 1609 1610 if (ins->master_mix_scb->sub_list_ptr != ins->the_null_scb) { 1611 parent_scb = find_next_free_scb (chip,ins->master_mix_scb->sub_list_ptr); 1612 parent_scb->next_scb_ptr = src; 1613 } else { 1614 parent_scb = ins->master_mix_scb; 1615 parent_scb->sub_list_ptr = src; 1616 } 1617 1618 src->parent_scb_ptr = parent_scb; 1619 1620 /* update entry in DSP RAM */ 1621 cs46xx_dsp_spos_update_scb(chip,parent_scb); 1622 1623 return 0; 1624 } 1625 1626 int cs46xx_dsp_enable_spdif_out (struct snd_cs46xx *chip) 1627 { 1628 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 1629 1630 if ( ! (ins->spdif_status_out & DSP_SPDIF_STATUS_HW_ENABLED) ) { 1631 cs46xx_dsp_enable_spdif_hw (chip); 1632 } 1633 1634 /* dont touch anything if SPDIF is open */ 1635 if ( ins->spdif_status_out & DSP_SPDIF_STATUS_PLAYBACK_OPEN) { 1636 /* when cs46xx_iec958_post_close(...) is called it 1637 will call this function if necessary depending on 1638 this bit */ 1639 ins->spdif_status_out |= DSP_SPDIF_STATUS_OUTPUT_ENABLED; 1640 1641 return -EBUSY; 1642 } 1643 1644 if (snd_BUG_ON(ins->asynch_tx_scb)) 1645 return -EINVAL; 1646 if (snd_BUG_ON(ins->master_mix_scb->next_scb_ptr != 1647 ins->the_null_scb)) 1648 return -EINVAL; 1649 1650 /* reset output snooper sample buffer pointer */ 1651 snd_cs46xx_poke (chip, (ins->ref_snoop_scb->address + 2) << 2, 1652 (OUTPUT_SNOOP_BUFFER + 0x10) << 0x10 ); 1653 1654 /* The asynch. transfer task */ 1655 ins->asynch_tx_scb = cs46xx_dsp_create_asynch_fg_tx_scb(chip,"AsynchFGTxSCB",ASYNCTX_SCB_ADDR, 1656 SPDIFO_SCB_INST, 1657 SPDIFO_IP_OUTPUT_BUFFER1, 1658 ins->master_mix_scb, 1659 SCB_ON_PARENT_NEXT_SCB); 1660 if (!ins->asynch_tx_scb) return -ENOMEM; 1661 1662 ins->spdif_pcm_input_scb = cs46xx_dsp_create_pcm_serial_input_scb(chip,"PCMSerialInput_II", 1663 PCMSERIALINII_SCB_ADDR, 1664 ins->ref_snoop_scb, 1665 ins->asynch_tx_scb, 1666 SCB_ON_PARENT_SUBLIST_SCB); 1667 1668 1669 if (!ins->spdif_pcm_input_scb) return -ENOMEM; 1670 1671 /* monitor state */ 1672 ins->spdif_status_out |= DSP_SPDIF_STATUS_OUTPUT_ENABLED; 1673 1674 return 0; 1675 } 1676 1677 int cs46xx_dsp_disable_spdif_out (struct snd_cs46xx *chip) 1678 { 1679 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 1680 1681 /* dont touch anything if SPDIF is open */ 1682 if ( ins->spdif_status_out & DSP_SPDIF_STATUS_PLAYBACK_OPEN) { 1683 ins->spdif_status_out &= ~DSP_SPDIF_STATUS_OUTPUT_ENABLED; 1684 return -EBUSY; 1685 } 1686 1687 /* check integrety */ 1688 if (snd_BUG_ON(!ins->asynch_tx_scb)) 1689 return -EINVAL; 1690 if (snd_BUG_ON(!ins->spdif_pcm_input_scb)) 1691 return -EINVAL; 1692 if (snd_BUG_ON(ins->master_mix_scb->next_scb_ptr != ins->asynch_tx_scb)) 1693 return -EINVAL; 1694 if (snd_BUG_ON(ins->asynch_tx_scb->parent_scb_ptr != 1695 ins->master_mix_scb)) 1696 return -EINVAL; 1697 1698 cs46xx_dsp_remove_scb (chip,ins->spdif_pcm_input_scb); 1699 cs46xx_dsp_remove_scb (chip,ins->asynch_tx_scb); 1700 1701 ins->spdif_pcm_input_scb = NULL; 1702 ins->asynch_tx_scb = NULL; 1703 1704 /* clear buffer to prevent any undesired noise */ 1705 _dsp_clear_sample_buffer(chip,SPDIFO_IP_OUTPUT_BUFFER1,256); 1706 1707 /* monitor state */ 1708 ins->spdif_status_out &= ~DSP_SPDIF_STATUS_OUTPUT_ENABLED; 1709 1710 1711 return 0; 1712 } 1713 1714 int cs46xx_iec958_pre_open (struct snd_cs46xx *chip) 1715 { 1716 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 1717 1718 if ( ins->spdif_status_out & DSP_SPDIF_STATUS_OUTPUT_ENABLED ) { 1719 /* remove AsynchFGTxSCB and and PCMSerialInput_II */ 1720 cs46xx_dsp_disable_spdif_out (chip); 1721 1722 /* save state */ 1723 ins->spdif_status_out |= DSP_SPDIF_STATUS_OUTPUT_ENABLED; 1724 } 1725 1726 /* if not enabled already */ 1727 if ( !(ins->spdif_status_out & DSP_SPDIF_STATUS_HW_ENABLED) ) { 1728 cs46xx_dsp_enable_spdif_hw (chip); 1729 } 1730 1731 /* Create the asynch. transfer task for playback */ 1732 ins->asynch_tx_scb = cs46xx_dsp_create_asynch_fg_tx_scb(chip,"AsynchFGTxSCB",ASYNCTX_SCB_ADDR, 1733 SPDIFO_SCB_INST, 1734 SPDIFO_IP_OUTPUT_BUFFER1, 1735 ins->master_mix_scb, 1736 SCB_ON_PARENT_NEXT_SCB); 1737 1738 1739 /* set spdif channel status value for streaming */ 1740 cs46xx_poke_via_dsp (chip,SP_SPDOUT_CSUV, ins->spdif_csuv_stream); 1741 1742 ins->spdif_status_out |= DSP_SPDIF_STATUS_PLAYBACK_OPEN; 1743 1744 return 0; 1745 } 1746 1747 int cs46xx_iec958_post_close (struct snd_cs46xx *chip) 1748 { 1749 struct dsp_spos_instance * ins = chip->dsp_spos_instance; 1750 1751 if (snd_BUG_ON(!ins->asynch_tx_scb)) 1752 return -EINVAL; 1753 1754 ins->spdif_status_out &= ~DSP_SPDIF_STATUS_PLAYBACK_OPEN; 1755 1756 /* restore settings */ 1757 cs46xx_poke_via_dsp (chip,SP_SPDOUT_CSUV, ins->spdif_csuv_default); 1758 1759 /* deallocate stuff */ 1760 if (ins->spdif_pcm_input_scb != NULL) { 1761 cs46xx_dsp_remove_scb (chip,ins->spdif_pcm_input_scb); 1762 ins->spdif_pcm_input_scb = NULL; 1763 } 1764 1765 cs46xx_dsp_remove_scb (chip,ins->asynch_tx_scb); 1766 ins->asynch_tx_scb = NULL; 1767 1768 /* clear buffer to prevent any undesired noise */ 1769 _dsp_clear_sample_buffer(chip,SPDIFO_IP_OUTPUT_BUFFER1,256); 1770 1771 /* restore state */ 1772 if ( ins->spdif_status_out & DSP_SPDIF_STATUS_OUTPUT_ENABLED ) { 1773 cs46xx_dsp_enable_spdif_out (chip); 1774 } 1775 1776 return 0; 1777 } 1778