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