162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci */ 462306a36Sopenharmony_ci 562306a36Sopenharmony_ci/* 662306a36Sopenharmony_ci * 2002-07 Benny Sjostrand benny@hostmobility.com 762306a36Sopenharmony_ci */ 862306a36Sopenharmony_ci 962306a36Sopenharmony_ci 1062306a36Sopenharmony_ci#include <linux/io.h> 1162306a36Sopenharmony_ci#include <linux/delay.h> 1262306a36Sopenharmony_ci#include <linux/pm.h> 1362306a36Sopenharmony_ci#include <linux/init.h> 1462306a36Sopenharmony_ci#include <linux/slab.h> 1562306a36Sopenharmony_ci#include <linux/vmalloc.h> 1662306a36Sopenharmony_ci#include <linux/mutex.h> 1762306a36Sopenharmony_ci 1862306a36Sopenharmony_ci#include <sound/core.h> 1962306a36Sopenharmony_ci#include <sound/control.h> 2062306a36Sopenharmony_ci#include <sound/info.h> 2162306a36Sopenharmony_ci#include <sound/asoundef.h> 2262306a36Sopenharmony_ci#include "cs46xx.h" 2362306a36Sopenharmony_ci 2462306a36Sopenharmony_ci#include "cs46xx_lib.h" 2562306a36Sopenharmony_ci#include "dsp_spos.h" 2662306a36Sopenharmony_ci 2762306a36Sopenharmony_cistatic int cs46xx_dsp_async_init (struct snd_cs46xx *chip, 2862306a36Sopenharmony_ci struct dsp_scb_descriptor * fg_entry); 2962306a36Sopenharmony_ci 3062306a36Sopenharmony_cistatic const enum wide_opcode wide_opcodes[] = { 3162306a36Sopenharmony_ci WIDE_FOR_BEGIN_LOOP, 3262306a36Sopenharmony_ci WIDE_FOR_BEGIN_LOOP2, 3362306a36Sopenharmony_ci WIDE_COND_GOTO_ADDR, 3462306a36Sopenharmony_ci WIDE_COND_GOTO_CALL, 3562306a36Sopenharmony_ci WIDE_TBEQ_COND_GOTO_ADDR, 3662306a36Sopenharmony_ci WIDE_TBEQ_COND_CALL_ADDR, 3762306a36Sopenharmony_ci WIDE_TBEQ_NCOND_GOTO_ADDR, 3862306a36Sopenharmony_ci WIDE_TBEQ_NCOND_CALL_ADDR, 3962306a36Sopenharmony_ci WIDE_TBEQ_COND_GOTO1_ADDR, 4062306a36Sopenharmony_ci WIDE_TBEQ_COND_CALL1_ADDR, 4162306a36Sopenharmony_ci WIDE_TBEQ_NCOND_GOTOI_ADDR, 4262306a36Sopenharmony_ci WIDE_TBEQ_NCOND_CALL1_ADDR 4362306a36Sopenharmony_ci}; 4462306a36Sopenharmony_ci 4562306a36Sopenharmony_cistatic int shadow_and_reallocate_code (struct snd_cs46xx * chip, u32 * data, u32 size, 4662306a36Sopenharmony_ci u32 overlay_begin_address) 4762306a36Sopenharmony_ci{ 4862306a36Sopenharmony_ci unsigned int i = 0, j, nreallocated = 0; 4962306a36Sopenharmony_ci u32 hival,loval,address; 5062306a36Sopenharmony_ci u32 mop_operands,mop_type,wide_op; 5162306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_ci if (snd_BUG_ON(size %2)) 5462306a36Sopenharmony_ci return -EINVAL; 5562306a36Sopenharmony_ci 5662306a36Sopenharmony_ci while (i < size) { 5762306a36Sopenharmony_ci loval = data[i++]; 5862306a36Sopenharmony_ci hival = data[i++]; 5962306a36Sopenharmony_ci 6062306a36Sopenharmony_ci if (ins->code.offset > 0) { 6162306a36Sopenharmony_ci mop_operands = (hival >> 6) & 0x03fff; 6262306a36Sopenharmony_ci mop_type = mop_operands >> 10; 6362306a36Sopenharmony_ci 6462306a36Sopenharmony_ci /* check for wide type instruction */ 6562306a36Sopenharmony_ci if (mop_type == 0 && 6662306a36Sopenharmony_ci (mop_operands & WIDE_LADD_INSTR_MASK) == 0 && 6762306a36Sopenharmony_ci (mop_operands & WIDE_INSTR_MASK) != 0) { 6862306a36Sopenharmony_ci wide_op = loval & 0x7f; 6962306a36Sopenharmony_ci for (j = 0;j < ARRAY_SIZE(wide_opcodes); ++j) { 7062306a36Sopenharmony_ci if (wide_opcodes[j] == wide_op) { 7162306a36Sopenharmony_ci /* need to reallocate instruction */ 7262306a36Sopenharmony_ci address = (hival & 0x00FFF) << 5; 7362306a36Sopenharmony_ci address |= loval >> 15; 7462306a36Sopenharmony_ci 7562306a36Sopenharmony_ci dev_dbg(chip->card->dev, 7662306a36Sopenharmony_ci "handle_wideop[1]: %05x:%05x addr %04x\n", 7762306a36Sopenharmony_ci hival, loval, address); 7862306a36Sopenharmony_ci 7962306a36Sopenharmony_ci if ( !(address & 0x8000) ) { 8062306a36Sopenharmony_ci address += (ins->code.offset / 2) - overlay_begin_address; 8162306a36Sopenharmony_ci } else { 8262306a36Sopenharmony_ci dev_dbg(chip->card->dev, 8362306a36Sopenharmony_ci "handle_wideop[1]: ROM symbol not reallocated\n"); 8462306a36Sopenharmony_ci } 8562306a36Sopenharmony_ci 8662306a36Sopenharmony_ci hival &= 0xFF000; 8762306a36Sopenharmony_ci loval &= 0x07FFF; 8862306a36Sopenharmony_ci 8962306a36Sopenharmony_ci hival |= ( (address >> 5) & 0x00FFF); 9062306a36Sopenharmony_ci loval |= ( (address << 15) & 0xF8000); 9162306a36Sopenharmony_ci 9262306a36Sopenharmony_ci address = (hival & 0x00FFF) << 5; 9362306a36Sopenharmony_ci address |= loval >> 15; 9462306a36Sopenharmony_ci 9562306a36Sopenharmony_ci dev_dbg(chip->card->dev, 9662306a36Sopenharmony_ci "handle_wideop:[2] %05x:%05x addr %04x\n", 9762306a36Sopenharmony_ci hival, loval, address); 9862306a36Sopenharmony_ci nreallocated++; 9962306a36Sopenharmony_ci } /* wide_opcodes[j] == wide_op */ 10062306a36Sopenharmony_ci } /* for */ 10162306a36Sopenharmony_ci } /* mod_type == 0 ... */ 10262306a36Sopenharmony_ci } /* ins->code.offset > 0 */ 10362306a36Sopenharmony_ci 10462306a36Sopenharmony_ci ins->code.data[ins->code.size++] = loval; 10562306a36Sopenharmony_ci ins->code.data[ins->code.size++] = hival; 10662306a36Sopenharmony_ci } 10762306a36Sopenharmony_ci 10862306a36Sopenharmony_ci dev_dbg(chip->card->dev, 10962306a36Sopenharmony_ci "dsp_spos: %d instructions reallocated\n", nreallocated); 11062306a36Sopenharmony_ci return nreallocated; 11162306a36Sopenharmony_ci} 11262306a36Sopenharmony_ci 11362306a36Sopenharmony_cistatic struct dsp_segment_desc * get_segment_desc (struct dsp_module_desc * module, int seg_type) 11462306a36Sopenharmony_ci{ 11562306a36Sopenharmony_ci int i; 11662306a36Sopenharmony_ci for (i = 0;i < module->nsegments; ++i) { 11762306a36Sopenharmony_ci if (module->segments[i].segment_type == seg_type) { 11862306a36Sopenharmony_ci return (module->segments + i); 11962306a36Sopenharmony_ci } 12062306a36Sopenharmony_ci } 12162306a36Sopenharmony_ci 12262306a36Sopenharmony_ci return NULL; 12362306a36Sopenharmony_ci}; 12462306a36Sopenharmony_ci 12562306a36Sopenharmony_cistatic int find_free_symbol_index (struct dsp_spos_instance * ins) 12662306a36Sopenharmony_ci{ 12762306a36Sopenharmony_ci int index = ins->symbol_table.nsymbols,i; 12862306a36Sopenharmony_ci 12962306a36Sopenharmony_ci for (i = ins->symbol_table.highest_frag_index; i < ins->symbol_table.nsymbols; ++i) { 13062306a36Sopenharmony_ci if (ins->symbol_table.symbols[i].deleted) { 13162306a36Sopenharmony_ci index = i; 13262306a36Sopenharmony_ci break; 13362306a36Sopenharmony_ci } 13462306a36Sopenharmony_ci } 13562306a36Sopenharmony_ci 13662306a36Sopenharmony_ci return index; 13762306a36Sopenharmony_ci} 13862306a36Sopenharmony_ci 13962306a36Sopenharmony_cistatic int add_symbols (struct snd_cs46xx * chip, struct dsp_module_desc * module) 14062306a36Sopenharmony_ci{ 14162306a36Sopenharmony_ci int i; 14262306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 14362306a36Sopenharmony_ci 14462306a36Sopenharmony_ci if (module->symbol_table.nsymbols > 0) { 14562306a36Sopenharmony_ci if (!strcmp(module->symbol_table.symbols[0].symbol_name, "OVERLAYBEGINADDRESS") && 14662306a36Sopenharmony_ci module->symbol_table.symbols[0].symbol_type == SYMBOL_CONSTANT ) { 14762306a36Sopenharmony_ci module->overlay_begin_address = module->symbol_table.symbols[0].address; 14862306a36Sopenharmony_ci } 14962306a36Sopenharmony_ci } 15062306a36Sopenharmony_ci 15162306a36Sopenharmony_ci for (i = 0;i < module->symbol_table.nsymbols; ++i) { 15262306a36Sopenharmony_ci if (ins->symbol_table.nsymbols == (DSP_MAX_SYMBOLS - 1)) { 15362306a36Sopenharmony_ci dev_err(chip->card->dev, 15462306a36Sopenharmony_ci "dsp_spos: symbol table is full\n"); 15562306a36Sopenharmony_ci return -ENOMEM; 15662306a36Sopenharmony_ci } 15762306a36Sopenharmony_ci 15862306a36Sopenharmony_ci 15962306a36Sopenharmony_ci if (cs46xx_dsp_lookup_symbol(chip, 16062306a36Sopenharmony_ci module->symbol_table.symbols[i].symbol_name, 16162306a36Sopenharmony_ci module->symbol_table.symbols[i].symbol_type) == NULL) { 16262306a36Sopenharmony_ci 16362306a36Sopenharmony_ci ins->symbol_table.symbols[ins->symbol_table.nsymbols] = module->symbol_table.symbols[i]; 16462306a36Sopenharmony_ci ins->symbol_table.symbols[ins->symbol_table.nsymbols].address += ((ins->code.offset / 2) - module->overlay_begin_address); 16562306a36Sopenharmony_ci ins->symbol_table.symbols[ins->symbol_table.nsymbols].module = module; 16662306a36Sopenharmony_ci ins->symbol_table.symbols[ins->symbol_table.nsymbols].deleted = 0; 16762306a36Sopenharmony_ci 16862306a36Sopenharmony_ci if (ins->symbol_table.nsymbols > ins->symbol_table.highest_frag_index) 16962306a36Sopenharmony_ci ins->symbol_table.highest_frag_index = ins->symbol_table.nsymbols; 17062306a36Sopenharmony_ci 17162306a36Sopenharmony_ci ins->symbol_table.nsymbols++; 17262306a36Sopenharmony_ci } else { 17362306a36Sopenharmony_ci#if 0 17462306a36Sopenharmony_ci dev_dbg(chip->card->dev, 17562306a36Sopenharmony_ci "dsp_spos: symbol <%s> duplicated, probably nothing wrong with that (Cirrus?)\n", 17662306a36Sopenharmony_ci module->symbol_table.symbols[i].symbol_name); */ 17762306a36Sopenharmony_ci#endif 17862306a36Sopenharmony_ci } 17962306a36Sopenharmony_ci } 18062306a36Sopenharmony_ci 18162306a36Sopenharmony_ci return 0; 18262306a36Sopenharmony_ci} 18362306a36Sopenharmony_ci 18462306a36Sopenharmony_cistatic struct dsp_symbol_entry * 18562306a36Sopenharmony_ciadd_symbol (struct snd_cs46xx * chip, char * symbol_name, u32 address, int type) 18662306a36Sopenharmony_ci{ 18762306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 18862306a36Sopenharmony_ci struct dsp_symbol_entry * symbol = NULL; 18962306a36Sopenharmony_ci int index; 19062306a36Sopenharmony_ci 19162306a36Sopenharmony_ci if (ins->symbol_table.nsymbols == (DSP_MAX_SYMBOLS - 1)) { 19262306a36Sopenharmony_ci dev_err(chip->card->dev, "dsp_spos: symbol table is full\n"); 19362306a36Sopenharmony_ci return NULL; 19462306a36Sopenharmony_ci } 19562306a36Sopenharmony_ci 19662306a36Sopenharmony_ci if (cs46xx_dsp_lookup_symbol(chip, 19762306a36Sopenharmony_ci symbol_name, 19862306a36Sopenharmony_ci type) != NULL) { 19962306a36Sopenharmony_ci dev_err(chip->card->dev, 20062306a36Sopenharmony_ci "dsp_spos: symbol <%s> duplicated\n", symbol_name); 20162306a36Sopenharmony_ci return NULL; 20262306a36Sopenharmony_ci } 20362306a36Sopenharmony_ci 20462306a36Sopenharmony_ci index = find_free_symbol_index (ins); 20562306a36Sopenharmony_ci 20662306a36Sopenharmony_ci strcpy (ins->symbol_table.symbols[index].symbol_name, symbol_name); 20762306a36Sopenharmony_ci ins->symbol_table.symbols[index].address = address; 20862306a36Sopenharmony_ci ins->symbol_table.symbols[index].symbol_type = type; 20962306a36Sopenharmony_ci ins->symbol_table.symbols[index].module = NULL; 21062306a36Sopenharmony_ci ins->symbol_table.symbols[index].deleted = 0; 21162306a36Sopenharmony_ci symbol = (ins->symbol_table.symbols + index); 21262306a36Sopenharmony_ci 21362306a36Sopenharmony_ci if (index > ins->symbol_table.highest_frag_index) 21462306a36Sopenharmony_ci ins->symbol_table.highest_frag_index = index; 21562306a36Sopenharmony_ci 21662306a36Sopenharmony_ci if (index == ins->symbol_table.nsymbols) 21762306a36Sopenharmony_ci ins->symbol_table.nsymbols++; /* no frag. in list */ 21862306a36Sopenharmony_ci 21962306a36Sopenharmony_ci return symbol; 22062306a36Sopenharmony_ci} 22162306a36Sopenharmony_ci 22262306a36Sopenharmony_cistruct dsp_spos_instance *cs46xx_dsp_spos_create (struct snd_cs46xx * chip) 22362306a36Sopenharmony_ci{ 22462306a36Sopenharmony_ci struct dsp_spos_instance * ins = kzalloc(sizeof(struct dsp_spos_instance), GFP_KERNEL); 22562306a36Sopenharmony_ci 22662306a36Sopenharmony_ci if (ins == NULL) 22762306a36Sopenharmony_ci return NULL; 22862306a36Sopenharmony_ci 22962306a36Sopenharmony_ci /* better to use vmalloc for this big table */ 23062306a36Sopenharmony_ci ins->symbol_table.symbols = 23162306a36Sopenharmony_ci vmalloc(array_size(DSP_MAX_SYMBOLS, 23262306a36Sopenharmony_ci sizeof(struct dsp_symbol_entry))); 23362306a36Sopenharmony_ci ins->code.data = kmalloc(DSP_CODE_BYTE_SIZE, GFP_KERNEL); 23462306a36Sopenharmony_ci ins->modules = kmalloc_array(DSP_MAX_MODULES, 23562306a36Sopenharmony_ci sizeof(struct dsp_module_desc), 23662306a36Sopenharmony_ci GFP_KERNEL); 23762306a36Sopenharmony_ci if (!ins->symbol_table.symbols || !ins->code.data || !ins->modules) { 23862306a36Sopenharmony_ci cs46xx_dsp_spos_destroy(chip); 23962306a36Sopenharmony_ci goto error; 24062306a36Sopenharmony_ci } 24162306a36Sopenharmony_ci ins->symbol_table.nsymbols = 0; 24262306a36Sopenharmony_ci ins->symbol_table.highest_frag_index = 0; 24362306a36Sopenharmony_ci ins->code.offset = 0; 24462306a36Sopenharmony_ci ins->code.size = 0; 24562306a36Sopenharmony_ci ins->nscb = 0; 24662306a36Sopenharmony_ci ins->ntask = 0; 24762306a36Sopenharmony_ci ins->nmodules = 0; 24862306a36Sopenharmony_ci 24962306a36Sopenharmony_ci /* default SPDIF input sample rate 25062306a36Sopenharmony_ci to 48000 khz */ 25162306a36Sopenharmony_ci ins->spdif_in_sample_rate = 48000; 25262306a36Sopenharmony_ci 25362306a36Sopenharmony_ci /* maximize volume */ 25462306a36Sopenharmony_ci ins->dac_volume_right = 0x8000; 25562306a36Sopenharmony_ci ins->dac_volume_left = 0x8000; 25662306a36Sopenharmony_ci ins->spdif_input_volume_right = 0x8000; 25762306a36Sopenharmony_ci ins->spdif_input_volume_left = 0x8000; 25862306a36Sopenharmony_ci 25962306a36Sopenharmony_ci /* set left and right validity bits and 26062306a36Sopenharmony_ci default channel status */ 26162306a36Sopenharmony_ci ins->spdif_csuv_default = 26262306a36Sopenharmony_ci ins->spdif_csuv_stream = 26362306a36Sopenharmony_ci /* byte 0 */ ((unsigned int)_wrap_all_bits( (SNDRV_PCM_DEFAULT_CON_SPDIF & 0xff)) << 24) | 26462306a36Sopenharmony_ci /* byte 1 */ ((unsigned int)_wrap_all_bits( ((SNDRV_PCM_DEFAULT_CON_SPDIF >> 8) & 0xff)) << 16) | 26562306a36Sopenharmony_ci /* byte 3 */ (unsigned int)_wrap_all_bits( (SNDRV_PCM_DEFAULT_CON_SPDIF >> 24) & 0xff) | 26662306a36Sopenharmony_ci /* left and right validity bits */ (1 << 13) | (1 << 12); 26762306a36Sopenharmony_ci 26862306a36Sopenharmony_ci return ins; 26962306a36Sopenharmony_ci 27062306a36Sopenharmony_cierror: 27162306a36Sopenharmony_ci kfree(ins->modules); 27262306a36Sopenharmony_ci kfree(ins->code.data); 27362306a36Sopenharmony_ci vfree(ins->symbol_table.symbols); 27462306a36Sopenharmony_ci kfree(ins); 27562306a36Sopenharmony_ci return NULL; 27662306a36Sopenharmony_ci} 27762306a36Sopenharmony_ci 27862306a36Sopenharmony_civoid cs46xx_dsp_spos_destroy (struct snd_cs46xx * chip) 27962306a36Sopenharmony_ci{ 28062306a36Sopenharmony_ci int i; 28162306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 28262306a36Sopenharmony_ci 28362306a36Sopenharmony_ci if (snd_BUG_ON(!ins)) 28462306a36Sopenharmony_ci return; 28562306a36Sopenharmony_ci 28662306a36Sopenharmony_ci mutex_lock(&chip->spos_mutex); 28762306a36Sopenharmony_ci for (i = 0; i < ins->nscb; ++i) { 28862306a36Sopenharmony_ci if (ins->scbs[i].deleted) continue; 28962306a36Sopenharmony_ci 29062306a36Sopenharmony_ci cs46xx_dsp_proc_free_scb_desc ( (ins->scbs + i) ); 29162306a36Sopenharmony_ci#ifdef CONFIG_PM_SLEEP 29262306a36Sopenharmony_ci kfree(ins->scbs[i].data); 29362306a36Sopenharmony_ci#endif 29462306a36Sopenharmony_ci } 29562306a36Sopenharmony_ci 29662306a36Sopenharmony_ci kfree(ins->code.data); 29762306a36Sopenharmony_ci vfree(ins->symbol_table.symbols); 29862306a36Sopenharmony_ci kfree(ins->modules); 29962306a36Sopenharmony_ci kfree(ins); 30062306a36Sopenharmony_ci mutex_unlock(&chip->spos_mutex); 30162306a36Sopenharmony_ci} 30262306a36Sopenharmony_ci 30362306a36Sopenharmony_cistatic int dsp_load_parameter(struct snd_cs46xx *chip, 30462306a36Sopenharmony_ci struct dsp_segment_desc *parameter) 30562306a36Sopenharmony_ci{ 30662306a36Sopenharmony_ci u32 doffset, dsize; 30762306a36Sopenharmony_ci 30862306a36Sopenharmony_ci if (!parameter) { 30962306a36Sopenharmony_ci dev_dbg(chip->card->dev, 31062306a36Sopenharmony_ci "dsp_spos: module got no parameter segment\n"); 31162306a36Sopenharmony_ci return 0; 31262306a36Sopenharmony_ci } 31362306a36Sopenharmony_ci 31462306a36Sopenharmony_ci doffset = (parameter->offset * 4 + DSP_PARAMETER_BYTE_OFFSET); 31562306a36Sopenharmony_ci dsize = parameter->size * 4; 31662306a36Sopenharmony_ci 31762306a36Sopenharmony_ci dev_dbg(chip->card->dev, 31862306a36Sopenharmony_ci "dsp_spos: downloading parameter data to chip (%08x-%08x)\n", 31962306a36Sopenharmony_ci doffset,doffset + dsize); 32062306a36Sopenharmony_ci if (snd_cs46xx_download (chip, parameter->data, doffset, dsize)) { 32162306a36Sopenharmony_ci dev_err(chip->card->dev, 32262306a36Sopenharmony_ci "dsp_spos: failed to download parameter data to DSP\n"); 32362306a36Sopenharmony_ci return -EINVAL; 32462306a36Sopenharmony_ci } 32562306a36Sopenharmony_ci return 0; 32662306a36Sopenharmony_ci} 32762306a36Sopenharmony_ci 32862306a36Sopenharmony_cistatic int dsp_load_sample(struct snd_cs46xx *chip, 32962306a36Sopenharmony_ci struct dsp_segment_desc *sample) 33062306a36Sopenharmony_ci{ 33162306a36Sopenharmony_ci u32 doffset, dsize; 33262306a36Sopenharmony_ci 33362306a36Sopenharmony_ci if (!sample) { 33462306a36Sopenharmony_ci dev_dbg(chip->card->dev, 33562306a36Sopenharmony_ci "dsp_spos: module got no sample segment\n"); 33662306a36Sopenharmony_ci return 0; 33762306a36Sopenharmony_ci } 33862306a36Sopenharmony_ci 33962306a36Sopenharmony_ci doffset = (sample->offset * 4 + DSP_SAMPLE_BYTE_OFFSET); 34062306a36Sopenharmony_ci dsize = sample->size * 4; 34162306a36Sopenharmony_ci 34262306a36Sopenharmony_ci dev_dbg(chip->card->dev, 34362306a36Sopenharmony_ci "dsp_spos: downloading sample data to chip (%08x-%08x)\n", 34462306a36Sopenharmony_ci doffset,doffset + dsize); 34562306a36Sopenharmony_ci 34662306a36Sopenharmony_ci if (snd_cs46xx_download (chip,sample->data,doffset,dsize)) { 34762306a36Sopenharmony_ci dev_err(chip->card->dev, 34862306a36Sopenharmony_ci "dsp_spos: failed to sample data to DSP\n"); 34962306a36Sopenharmony_ci return -EINVAL; 35062306a36Sopenharmony_ci } 35162306a36Sopenharmony_ci return 0; 35262306a36Sopenharmony_ci} 35362306a36Sopenharmony_ci 35462306a36Sopenharmony_ciint cs46xx_dsp_load_module (struct snd_cs46xx * chip, struct dsp_module_desc * module) 35562306a36Sopenharmony_ci{ 35662306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 35762306a36Sopenharmony_ci struct dsp_segment_desc * code = get_segment_desc (module,SEGTYPE_SP_PROGRAM); 35862306a36Sopenharmony_ci u32 doffset, dsize; 35962306a36Sopenharmony_ci int err; 36062306a36Sopenharmony_ci 36162306a36Sopenharmony_ci if (ins->nmodules == DSP_MAX_MODULES - 1) { 36262306a36Sopenharmony_ci dev_err(chip->card->dev, 36362306a36Sopenharmony_ci "dsp_spos: to many modules loaded into DSP\n"); 36462306a36Sopenharmony_ci return -ENOMEM; 36562306a36Sopenharmony_ci } 36662306a36Sopenharmony_ci 36762306a36Sopenharmony_ci dev_dbg(chip->card->dev, 36862306a36Sopenharmony_ci "dsp_spos: loading module %s into DSP\n", module->module_name); 36962306a36Sopenharmony_ci 37062306a36Sopenharmony_ci if (ins->nmodules == 0) { 37162306a36Sopenharmony_ci dev_dbg(chip->card->dev, "dsp_spos: clearing parameter area\n"); 37262306a36Sopenharmony_ci snd_cs46xx_clear_BA1(chip, DSP_PARAMETER_BYTE_OFFSET, DSP_PARAMETER_BYTE_SIZE); 37362306a36Sopenharmony_ci } 37462306a36Sopenharmony_ci 37562306a36Sopenharmony_ci err = dsp_load_parameter(chip, get_segment_desc(module, 37662306a36Sopenharmony_ci SEGTYPE_SP_PARAMETER)); 37762306a36Sopenharmony_ci if (err < 0) 37862306a36Sopenharmony_ci return err; 37962306a36Sopenharmony_ci 38062306a36Sopenharmony_ci if (ins->nmodules == 0) { 38162306a36Sopenharmony_ci dev_dbg(chip->card->dev, "dsp_spos: clearing sample area\n"); 38262306a36Sopenharmony_ci snd_cs46xx_clear_BA1(chip, DSP_SAMPLE_BYTE_OFFSET, DSP_SAMPLE_BYTE_SIZE); 38362306a36Sopenharmony_ci } 38462306a36Sopenharmony_ci 38562306a36Sopenharmony_ci err = dsp_load_sample(chip, get_segment_desc(module, 38662306a36Sopenharmony_ci SEGTYPE_SP_SAMPLE)); 38762306a36Sopenharmony_ci if (err < 0) 38862306a36Sopenharmony_ci return err; 38962306a36Sopenharmony_ci 39062306a36Sopenharmony_ci if (ins->nmodules == 0) { 39162306a36Sopenharmony_ci dev_dbg(chip->card->dev, "dsp_spos: clearing code area\n"); 39262306a36Sopenharmony_ci snd_cs46xx_clear_BA1(chip, DSP_CODE_BYTE_OFFSET, DSP_CODE_BYTE_SIZE); 39362306a36Sopenharmony_ci } 39462306a36Sopenharmony_ci 39562306a36Sopenharmony_ci if (code == NULL) { 39662306a36Sopenharmony_ci dev_dbg(chip->card->dev, 39762306a36Sopenharmony_ci "dsp_spos: module got no code segment\n"); 39862306a36Sopenharmony_ci } else { 39962306a36Sopenharmony_ci if (ins->code.offset + code->size > DSP_CODE_BYTE_SIZE) { 40062306a36Sopenharmony_ci dev_err(chip->card->dev, 40162306a36Sopenharmony_ci "dsp_spos: no space available in DSP\n"); 40262306a36Sopenharmony_ci return -ENOMEM; 40362306a36Sopenharmony_ci } 40462306a36Sopenharmony_ci 40562306a36Sopenharmony_ci module->load_address = ins->code.offset; 40662306a36Sopenharmony_ci module->overlay_begin_address = 0x000; 40762306a36Sopenharmony_ci 40862306a36Sopenharmony_ci /* if module has a code segment it must have 40962306a36Sopenharmony_ci symbol table */ 41062306a36Sopenharmony_ci if (snd_BUG_ON(!module->symbol_table.symbols)) 41162306a36Sopenharmony_ci return -ENOMEM; 41262306a36Sopenharmony_ci if (add_symbols(chip,module)) { 41362306a36Sopenharmony_ci dev_err(chip->card->dev, 41462306a36Sopenharmony_ci "dsp_spos: failed to load symbol table\n"); 41562306a36Sopenharmony_ci return -ENOMEM; 41662306a36Sopenharmony_ci } 41762306a36Sopenharmony_ci 41862306a36Sopenharmony_ci doffset = (code->offset * 4 + ins->code.offset * 4 + DSP_CODE_BYTE_OFFSET); 41962306a36Sopenharmony_ci dsize = code->size * 4; 42062306a36Sopenharmony_ci dev_dbg(chip->card->dev, 42162306a36Sopenharmony_ci "dsp_spos: downloading code to chip (%08x-%08x)\n", 42262306a36Sopenharmony_ci doffset,doffset + dsize); 42362306a36Sopenharmony_ci 42462306a36Sopenharmony_ci module->nfixups = shadow_and_reallocate_code(chip,code->data,code->size,module->overlay_begin_address); 42562306a36Sopenharmony_ci 42662306a36Sopenharmony_ci if (snd_cs46xx_download (chip,(ins->code.data + ins->code.offset),doffset,dsize)) { 42762306a36Sopenharmony_ci dev_err(chip->card->dev, 42862306a36Sopenharmony_ci "dsp_spos: failed to download code to DSP\n"); 42962306a36Sopenharmony_ci return -EINVAL; 43062306a36Sopenharmony_ci } 43162306a36Sopenharmony_ci 43262306a36Sopenharmony_ci ins->code.offset += code->size; 43362306a36Sopenharmony_ci } 43462306a36Sopenharmony_ci 43562306a36Sopenharmony_ci /* NOTE: module segments and symbol table must be 43662306a36Sopenharmony_ci statically allocated. Case that module data is 43762306a36Sopenharmony_ci not generated by the ospparser */ 43862306a36Sopenharmony_ci ins->modules[ins->nmodules] = *module; 43962306a36Sopenharmony_ci ins->nmodules++; 44062306a36Sopenharmony_ci 44162306a36Sopenharmony_ci return 0; 44262306a36Sopenharmony_ci} 44362306a36Sopenharmony_ci 44462306a36Sopenharmony_cistruct dsp_symbol_entry * 44562306a36Sopenharmony_cics46xx_dsp_lookup_symbol (struct snd_cs46xx * chip, char * symbol_name, int symbol_type) 44662306a36Sopenharmony_ci{ 44762306a36Sopenharmony_ci int i; 44862306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 44962306a36Sopenharmony_ci 45062306a36Sopenharmony_ci for ( i = 0; i < ins->symbol_table.nsymbols; ++i ) { 45162306a36Sopenharmony_ci 45262306a36Sopenharmony_ci if (ins->symbol_table.symbols[i].deleted) 45362306a36Sopenharmony_ci continue; 45462306a36Sopenharmony_ci 45562306a36Sopenharmony_ci if (!strcmp(ins->symbol_table.symbols[i].symbol_name,symbol_name) && 45662306a36Sopenharmony_ci ins->symbol_table.symbols[i].symbol_type == symbol_type) { 45762306a36Sopenharmony_ci return (ins->symbol_table.symbols + i); 45862306a36Sopenharmony_ci } 45962306a36Sopenharmony_ci } 46062306a36Sopenharmony_ci 46162306a36Sopenharmony_ci#if 0 46262306a36Sopenharmony_ci dev_err(chip->card->dev, "dsp_spos: symbol <%s> type %02x not found\n", 46362306a36Sopenharmony_ci symbol_name,symbol_type); 46462306a36Sopenharmony_ci#endif 46562306a36Sopenharmony_ci 46662306a36Sopenharmony_ci return NULL; 46762306a36Sopenharmony_ci} 46862306a36Sopenharmony_ci 46962306a36Sopenharmony_ci 47062306a36Sopenharmony_ci#ifdef CONFIG_SND_PROC_FS 47162306a36Sopenharmony_cistatic struct dsp_symbol_entry * 47262306a36Sopenharmony_cics46xx_dsp_lookup_symbol_addr (struct snd_cs46xx * chip, u32 address, int symbol_type) 47362306a36Sopenharmony_ci{ 47462306a36Sopenharmony_ci int i; 47562306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 47662306a36Sopenharmony_ci 47762306a36Sopenharmony_ci for ( i = 0; i < ins->symbol_table.nsymbols; ++i ) { 47862306a36Sopenharmony_ci 47962306a36Sopenharmony_ci if (ins->symbol_table.symbols[i].deleted) 48062306a36Sopenharmony_ci continue; 48162306a36Sopenharmony_ci 48262306a36Sopenharmony_ci if (ins->symbol_table.symbols[i].address == address && 48362306a36Sopenharmony_ci ins->symbol_table.symbols[i].symbol_type == symbol_type) { 48462306a36Sopenharmony_ci return (ins->symbol_table.symbols + i); 48562306a36Sopenharmony_ci } 48662306a36Sopenharmony_ci } 48762306a36Sopenharmony_ci 48862306a36Sopenharmony_ci 48962306a36Sopenharmony_ci return NULL; 49062306a36Sopenharmony_ci} 49162306a36Sopenharmony_ci 49262306a36Sopenharmony_ci 49362306a36Sopenharmony_cistatic void cs46xx_dsp_proc_symbol_table_read (struct snd_info_entry *entry, 49462306a36Sopenharmony_ci struct snd_info_buffer *buffer) 49562306a36Sopenharmony_ci{ 49662306a36Sopenharmony_ci struct snd_cs46xx *chip = entry->private_data; 49762306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 49862306a36Sopenharmony_ci int i; 49962306a36Sopenharmony_ci 50062306a36Sopenharmony_ci snd_iprintf(buffer, "SYMBOLS:\n"); 50162306a36Sopenharmony_ci for ( i = 0; i < ins->symbol_table.nsymbols; ++i ) { 50262306a36Sopenharmony_ci char *module_str = "system"; 50362306a36Sopenharmony_ci 50462306a36Sopenharmony_ci if (ins->symbol_table.symbols[i].deleted) 50562306a36Sopenharmony_ci continue; 50662306a36Sopenharmony_ci 50762306a36Sopenharmony_ci if (ins->symbol_table.symbols[i].module != NULL) { 50862306a36Sopenharmony_ci module_str = ins->symbol_table.symbols[i].module->module_name; 50962306a36Sopenharmony_ci } 51062306a36Sopenharmony_ci 51162306a36Sopenharmony_ci 51262306a36Sopenharmony_ci snd_iprintf(buffer, "%04X <%02X> %s [%s]\n", 51362306a36Sopenharmony_ci ins->symbol_table.symbols[i].address, 51462306a36Sopenharmony_ci ins->symbol_table.symbols[i].symbol_type, 51562306a36Sopenharmony_ci ins->symbol_table.symbols[i].symbol_name, 51662306a36Sopenharmony_ci module_str); 51762306a36Sopenharmony_ci } 51862306a36Sopenharmony_ci} 51962306a36Sopenharmony_ci 52062306a36Sopenharmony_ci 52162306a36Sopenharmony_cistatic void cs46xx_dsp_proc_modules_read (struct snd_info_entry *entry, 52262306a36Sopenharmony_ci struct snd_info_buffer *buffer) 52362306a36Sopenharmony_ci{ 52462306a36Sopenharmony_ci struct snd_cs46xx *chip = entry->private_data; 52562306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 52662306a36Sopenharmony_ci int i,j; 52762306a36Sopenharmony_ci 52862306a36Sopenharmony_ci mutex_lock(&chip->spos_mutex); 52962306a36Sopenharmony_ci snd_iprintf(buffer, "MODULES:\n"); 53062306a36Sopenharmony_ci for ( i = 0; i < ins->nmodules; ++i ) { 53162306a36Sopenharmony_ci snd_iprintf(buffer, "\n%s:\n", ins->modules[i].module_name); 53262306a36Sopenharmony_ci snd_iprintf(buffer, " %d symbols\n", ins->modules[i].symbol_table.nsymbols); 53362306a36Sopenharmony_ci snd_iprintf(buffer, " %d fixups\n", ins->modules[i].nfixups); 53462306a36Sopenharmony_ci 53562306a36Sopenharmony_ci for (j = 0; j < ins->modules[i].nsegments; ++ j) { 53662306a36Sopenharmony_ci struct dsp_segment_desc * desc = (ins->modules[i].segments + j); 53762306a36Sopenharmony_ci snd_iprintf(buffer, " segment %02x offset %08x size %08x\n", 53862306a36Sopenharmony_ci desc->segment_type,desc->offset, desc->size); 53962306a36Sopenharmony_ci } 54062306a36Sopenharmony_ci } 54162306a36Sopenharmony_ci mutex_unlock(&chip->spos_mutex); 54262306a36Sopenharmony_ci} 54362306a36Sopenharmony_ci 54462306a36Sopenharmony_cistatic void cs46xx_dsp_proc_task_tree_read (struct snd_info_entry *entry, 54562306a36Sopenharmony_ci struct snd_info_buffer *buffer) 54662306a36Sopenharmony_ci{ 54762306a36Sopenharmony_ci struct snd_cs46xx *chip = entry->private_data; 54862306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 54962306a36Sopenharmony_ci int i, j, col; 55062306a36Sopenharmony_ci void __iomem *dst = chip->region.idx[1].remap_addr + DSP_PARAMETER_BYTE_OFFSET; 55162306a36Sopenharmony_ci 55262306a36Sopenharmony_ci mutex_lock(&chip->spos_mutex); 55362306a36Sopenharmony_ci snd_iprintf(buffer, "TASK TREES:\n"); 55462306a36Sopenharmony_ci for ( i = 0; i < ins->ntask; ++i) { 55562306a36Sopenharmony_ci snd_iprintf(buffer,"\n%04x %s:\n",ins->tasks[i].address,ins->tasks[i].task_name); 55662306a36Sopenharmony_ci 55762306a36Sopenharmony_ci for (col = 0,j = 0;j < ins->tasks[i].size; j++,col++) { 55862306a36Sopenharmony_ci u32 val; 55962306a36Sopenharmony_ci if (col == 4) { 56062306a36Sopenharmony_ci snd_iprintf(buffer,"\n"); 56162306a36Sopenharmony_ci col = 0; 56262306a36Sopenharmony_ci } 56362306a36Sopenharmony_ci val = readl(dst + (ins->tasks[i].address + j) * sizeof(u32)); 56462306a36Sopenharmony_ci snd_iprintf(buffer,"%08x ",val); 56562306a36Sopenharmony_ci } 56662306a36Sopenharmony_ci } 56762306a36Sopenharmony_ci 56862306a36Sopenharmony_ci snd_iprintf(buffer,"\n"); 56962306a36Sopenharmony_ci mutex_unlock(&chip->spos_mutex); 57062306a36Sopenharmony_ci} 57162306a36Sopenharmony_ci 57262306a36Sopenharmony_cistatic void cs46xx_dsp_proc_scb_read (struct snd_info_entry *entry, 57362306a36Sopenharmony_ci struct snd_info_buffer *buffer) 57462306a36Sopenharmony_ci{ 57562306a36Sopenharmony_ci struct snd_cs46xx *chip = entry->private_data; 57662306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 57762306a36Sopenharmony_ci int i; 57862306a36Sopenharmony_ci 57962306a36Sopenharmony_ci mutex_lock(&chip->spos_mutex); 58062306a36Sopenharmony_ci snd_iprintf(buffer, "SCB's:\n"); 58162306a36Sopenharmony_ci for ( i = 0; i < ins->nscb; ++i) { 58262306a36Sopenharmony_ci if (ins->scbs[i].deleted) 58362306a36Sopenharmony_ci continue; 58462306a36Sopenharmony_ci snd_iprintf(buffer,"\n%04x %s:\n\n",ins->scbs[i].address,ins->scbs[i].scb_name); 58562306a36Sopenharmony_ci 58662306a36Sopenharmony_ci if (ins->scbs[i].parent_scb_ptr != NULL) { 58762306a36Sopenharmony_ci snd_iprintf(buffer,"parent [%s:%04x] ", 58862306a36Sopenharmony_ci ins->scbs[i].parent_scb_ptr->scb_name, 58962306a36Sopenharmony_ci ins->scbs[i].parent_scb_ptr->address); 59062306a36Sopenharmony_ci } else snd_iprintf(buffer,"parent [none] "); 59162306a36Sopenharmony_ci 59262306a36Sopenharmony_ci snd_iprintf(buffer,"sub_list_ptr [%s:%04x]\nnext_scb_ptr [%s:%04x] task_entry [%s:%04x]\n", 59362306a36Sopenharmony_ci ins->scbs[i].sub_list_ptr->scb_name, 59462306a36Sopenharmony_ci ins->scbs[i].sub_list_ptr->address, 59562306a36Sopenharmony_ci ins->scbs[i].next_scb_ptr->scb_name, 59662306a36Sopenharmony_ci ins->scbs[i].next_scb_ptr->address, 59762306a36Sopenharmony_ci ins->scbs[i].task_entry->symbol_name, 59862306a36Sopenharmony_ci ins->scbs[i].task_entry->address); 59962306a36Sopenharmony_ci } 60062306a36Sopenharmony_ci 60162306a36Sopenharmony_ci snd_iprintf(buffer,"\n"); 60262306a36Sopenharmony_ci mutex_unlock(&chip->spos_mutex); 60362306a36Sopenharmony_ci} 60462306a36Sopenharmony_ci 60562306a36Sopenharmony_cistatic void cs46xx_dsp_proc_parameter_dump_read (struct snd_info_entry *entry, 60662306a36Sopenharmony_ci struct snd_info_buffer *buffer) 60762306a36Sopenharmony_ci{ 60862306a36Sopenharmony_ci struct snd_cs46xx *chip = entry->private_data; 60962306a36Sopenharmony_ci /*struct dsp_spos_instance * ins = chip->dsp_spos_instance; */ 61062306a36Sopenharmony_ci unsigned int i, col = 0; 61162306a36Sopenharmony_ci void __iomem *dst = chip->region.idx[1].remap_addr + DSP_PARAMETER_BYTE_OFFSET; 61262306a36Sopenharmony_ci struct dsp_symbol_entry * symbol; 61362306a36Sopenharmony_ci 61462306a36Sopenharmony_ci for (i = 0;i < DSP_PARAMETER_BYTE_SIZE; i += sizeof(u32),col ++) { 61562306a36Sopenharmony_ci if (col == 4) { 61662306a36Sopenharmony_ci snd_iprintf(buffer,"\n"); 61762306a36Sopenharmony_ci col = 0; 61862306a36Sopenharmony_ci } 61962306a36Sopenharmony_ci 62062306a36Sopenharmony_ci symbol = cs46xx_dsp_lookup_symbol_addr(chip, i / sizeof(u32), SYMBOL_PARAMETER); 62162306a36Sopenharmony_ci if (symbol) { 62262306a36Sopenharmony_ci col = 0; 62362306a36Sopenharmony_ci snd_iprintf (buffer,"\n%s:\n",symbol->symbol_name); 62462306a36Sopenharmony_ci } 62562306a36Sopenharmony_ci 62662306a36Sopenharmony_ci if (col == 0) { 62762306a36Sopenharmony_ci snd_iprintf(buffer, "%04X ", i / (unsigned int)sizeof(u32)); 62862306a36Sopenharmony_ci } 62962306a36Sopenharmony_ci 63062306a36Sopenharmony_ci snd_iprintf(buffer,"%08X ",readl(dst + i)); 63162306a36Sopenharmony_ci } 63262306a36Sopenharmony_ci} 63362306a36Sopenharmony_ci 63462306a36Sopenharmony_cistatic void cs46xx_dsp_proc_sample_dump_read (struct snd_info_entry *entry, 63562306a36Sopenharmony_ci struct snd_info_buffer *buffer) 63662306a36Sopenharmony_ci{ 63762306a36Sopenharmony_ci struct snd_cs46xx *chip = entry->private_data; 63862306a36Sopenharmony_ci int i,col = 0; 63962306a36Sopenharmony_ci void __iomem *dst = chip->region.idx[2].remap_addr; 64062306a36Sopenharmony_ci 64162306a36Sopenharmony_ci snd_iprintf(buffer,"PCMREADER:\n"); 64262306a36Sopenharmony_ci for (i = PCM_READER_BUF1;i < PCM_READER_BUF1 + 0x30; i += sizeof(u32),col ++) { 64362306a36Sopenharmony_ci if (col == 4) { 64462306a36Sopenharmony_ci snd_iprintf(buffer,"\n"); 64562306a36Sopenharmony_ci col = 0; 64662306a36Sopenharmony_ci } 64762306a36Sopenharmony_ci 64862306a36Sopenharmony_ci if (col == 0) { 64962306a36Sopenharmony_ci snd_iprintf(buffer, "%04X ",i); 65062306a36Sopenharmony_ci } 65162306a36Sopenharmony_ci 65262306a36Sopenharmony_ci snd_iprintf(buffer,"%08X ",readl(dst + i)); 65362306a36Sopenharmony_ci } 65462306a36Sopenharmony_ci 65562306a36Sopenharmony_ci snd_iprintf(buffer,"\nMIX_SAMPLE_BUF1:\n"); 65662306a36Sopenharmony_ci 65762306a36Sopenharmony_ci col = 0; 65862306a36Sopenharmony_ci for (i = MIX_SAMPLE_BUF1;i < MIX_SAMPLE_BUF1 + 0x40; i += sizeof(u32),col ++) { 65962306a36Sopenharmony_ci if (col == 4) { 66062306a36Sopenharmony_ci snd_iprintf(buffer,"\n"); 66162306a36Sopenharmony_ci col = 0; 66262306a36Sopenharmony_ci } 66362306a36Sopenharmony_ci 66462306a36Sopenharmony_ci if (col == 0) { 66562306a36Sopenharmony_ci snd_iprintf(buffer, "%04X ",i); 66662306a36Sopenharmony_ci } 66762306a36Sopenharmony_ci 66862306a36Sopenharmony_ci snd_iprintf(buffer,"%08X ",readl(dst + i)); 66962306a36Sopenharmony_ci } 67062306a36Sopenharmony_ci 67162306a36Sopenharmony_ci snd_iprintf(buffer,"\nSRC_TASK_SCB1:\n"); 67262306a36Sopenharmony_ci col = 0; 67362306a36Sopenharmony_ci for (i = 0x2480 ; i < 0x2480 + 0x40 ; i += sizeof(u32),col ++) { 67462306a36Sopenharmony_ci if (col == 4) { 67562306a36Sopenharmony_ci snd_iprintf(buffer,"\n"); 67662306a36Sopenharmony_ci col = 0; 67762306a36Sopenharmony_ci } 67862306a36Sopenharmony_ci 67962306a36Sopenharmony_ci if (col == 0) { 68062306a36Sopenharmony_ci snd_iprintf(buffer, "%04X ",i); 68162306a36Sopenharmony_ci } 68262306a36Sopenharmony_ci 68362306a36Sopenharmony_ci snd_iprintf(buffer,"%08X ",readl(dst + i)); 68462306a36Sopenharmony_ci } 68562306a36Sopenharmony_ci 68662306a36Sopenharmony_ci 68762306a36Sopenharmony_ci snd_iprintf(buffer,"\nSPDIFO_BUFFER:\n"); 68862306a36Sopenharmony_ci col = 0; 68962306a36Sopenharmony_ci for (i = SPDIFO_IP_OUTPUT_BUFFER1;i < SPDIFO_IP_OUTPUT_BUFFER1 + 0x30; i += sizeof(u32),col ++) { 69062306a36Sopenharmony_ci if (col == 4) { 69162306a36Sopenharmony_ci snd_iprintf(buffer,"\n"); 69262306a36Sopenharmony_ci col = 0; 69362306a36Sopenharmony_ci } 69462306a36Sopenharmony_ci 69562306a36Sopenharmony_ci if (col == 0) { 69662306a36Sopenharmony_ci snd_iprintf(buffer, "%04X ",i); 69762306a36Sopenharmony_ci } 69862306a36Sopenharmony_ci 69962306a36Sopenharmony_ci snd_iprintf(buffer,"%08X ",readl(dst + i)); 70062306a36Sopenharmony_ci } 70162306a36Sopenharmony_ci 70262306a36Sopenharmony_ci snd_iprintf(buffer,"\n...\n"); 70362306a36Sopenharmony_ci col = 0; 70462306a36Sopenharmony_ci 70562306a36Sopenharmony_ci for (i = SPDIFO_IP_OUTPUT_BUFFER1+0xD0;i < SPDIFO_IP_OUTPUT_BUFFER1 + 0x110; i += sizeof(u32),col ++) { 70662306a36Sopenharmony_ci if (col == 4) { 70762306a36Sopenharmony_ci snd_iprintf(buffer,"\n"); 70862306a36Sopenharmony_ci col = 0; 70962306a36Sopenharmony_ci } 71062306a36Sopenharmony_ci 71162306a36Sopenharmony_ci if (col == 0) { 71262306a36Sopenharmony_ci snd_iprintf(buffer, "%04X ",i); 71362306a36Sopenharmony_ci } 71462306a36Sopenharmony_ci 71562306a36Sopenharmony_ci snd_iprintf(buffer,"%08X ",readl(dst + i)); 71662306a36Sopenharmony_ci } 71762306a36Sopenharmony_ci 71862306a36Sopenharmony_ci 71962306a36Sopenharmony_ci snd_iprintf(buffer,"\nOUTPUT_SNOOP:\n"); 72062306a36Sopenharmony_ci col = 0; 72162306a36Sopenharmony_ci for (i = OUTPUT_SNOOP_BUFFER;i < OUTPUT_SNOOP_BUFFER + 0x40; i += sizeof(u32),col ++) { 72262306a36Sopenharmony_ci if (col == 4) { 72362306a36Sopenharmony_ci snd_iprintf(buffer,"\n"); 72462306a36Sopenharmony_ci col = 0; 72562306a36Sopenharmony_ci } 72662306a36Sopenharmony_ci 72762306a36Sopenharmony_ci if (col == 0) { 72862306a36Sopenharmony_ci snd_iprintf(buffer, "%04X ",i); 72962306a36Sopenharmony_ci } 73062306a36Sopenharmony_ci 73162306a36Sopenharmony_ci snd_iprintf(buffer,"%08X ",readl(dst + i)); 73262306a36Sopenharmony_ci } 73362306a36Sopenharmony_ci 73462306a36Sopenharmony_ci snd_iprintf(buffer,"\nCODEC_INPUT_BUF1: \n"); 73562306a36Sopenharmony_ci col = 0; 73662306a36Sopenharmony_ci for (i = CODEC_INPUT_BUF1;i < CODEC_INPUT_BUF1 + 0x40; i += sizeof(u32),col ++) { 73762306a36Sopenharmony_ci if (col == 4) { 73862306a36Sopenharmony_ci snd_iprintf(buffer,"\n"); 73962306a36Sopenharmony_ci col = 0; 74062306a36Sopenharmony_ci } 74162306a36Sopenharmony_ci 74262306a36Sopenharmony_ci if (col == 0) { 74362306a36Sopenharmony_ci snd_iprintf(buffer, "%04X ",i); 74462306a36Sopenharmony_ci } 74562306a36Sopenharmony_ci 74662306a36Sopenharmony_ci snd_iprintf(buffer,"%08X ",readl(dst + i)); 74762306a36Sopenharmony_ci } 74862306a36Sopenharmony_ci#if 0 74962306a36Sopenharmony_ci snd_iprintf(buffer,"\nWRITE_BACK_BUF1: \n"); 75062306a36Sopenharmony_ci col = 0; 75162306a36Sopenharmony_ci for (i = WRITE_BACK_BUF1;i < WRITE_BACK_BUF1 + 0x40; i += sizeof(u32),col ++) { 75262306a36Sopenharmony_ci if (col == 4) { 75362306a36Sopenharmony_ci snd_iprintf(buffer,"\n"); 75462306a36Sopenharmony_ci col = 0; 75562306a36Sopenharmony_ci } 75662306a36Sopenharmony_ci 75762306a36Sopenharmony_ci if (col == 0) { 75862306a36Sopenharmony_ci snd_iprintf(buffer, "%04X ",i); 75962306a36Sopenharmony_ci } 76062306a36Sopenharmony_ci 76162306a36Sopenharmony_ci snd_iprintf(buffer,"%08X ",readl(dst + i)); 76262306a36Sopenharmony_ci } 76362306a36Sopenharmony_ci#endif 76462306a36Sopenharmony_ci 76562306a36Sopenharmony_ci snd_iprintf(buffer,"\nSPDIFI_IP_OUTPUT_BUFFER1: \n"); 76662306a36Sopenharmony_ci col = 0; 76762306a36Sopenharmony_ci for (i = SPDIFI_IP_OUTPUT_BUFFER1;i < SPDIFI_IP_OUTPUT_BUFFER1 + 0x80; i += sizeof(u32),col ++) { 76862306a36Sopenharmony_ci if (col == 4) { 76962306a36Sopenharmony_ci snd_iprintf(buffer,"\n"); 77062306a36Sopenharmony_ci col = 0; 77162306a36Sopenharmony_ci } 77262306a36Sopenharmony_ci 77362306a36Sopenharmony_ci if (col == 0) { 77462306a36Sopenharmony_ci snd_iprintf(buffer, "%04X ",i); 77562306a36Sopenharmony_ci } 77662306a36Sopenharmony_ci 77762306a36Sopenharmony_ci snd_iprintf(buffer,"%08X ",readl(dst + i)); 77862306a36Sopenharmony_ci } 77962306a36Sopenharmony_ci snd_iprintf(buffer,"\n"); 78062306a36Sopenharmony_ci} 78162306a36Sopenharmony_ci 78262306a36Sopenharmony_ciint cs46xx_dsp_proc_init (struct snd_card *card, struct snd_cs46xx *chip) 78362306a36Sopenharmony_ci{ 78462306a36Sopenharmony_ci struct snd_info_entry *entry; 78562306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 78662306a36Sopenharmony_ci int i; 78762306a36Sopenharmony_ci 78862306a36Sopenharmony_ci ins->snd_card = card; 78962306a36Sopenharmony_ci 79062306a36Sopenharmony_ci entry = snd_info_create_card_entry(card, "dsp", card->proc_root); 79162306a36Sopenharmony_ci if (entry) 79262306a36Sopenharmony_ci entry->mode = S_IFDIR | 0555; 79362306a36Sopenharmony_ci ins->proc_dsp_dir = entry; 79462306a36Sopenharmony_ci 79562306a36Sopenharmony_ci if (!ins->proc_dsp_dir) 79662306a36Sopenharmony_ci return -ENOMEM; 79762306a36Sopenharmony_ci 79862306a36Sopenharmony_ci entry = snd_info_create_card_entry(card, "spos_symbols", 79962306a36Sopenharmony_ci ins->proc_dsp_dir); 80062306a36Sopenharmony_ci if (entry) 80162306a36Sopenharmony_ci snd_info_set_text_ops(entry, chip, 80262306a36Sopenharmony_ci cs46xx_dsp_proc_symbol_table_read); 80362306a36Sopenharmony_ci 80462306a36Sopenharmony_ci entry = snd_info_create_card_entry(card, "spos_modules", 80562306a36Sopenharmony_ci ins->proc_dsp_dir); 80662306a36Sopenharmony_ci if (entry) 80762306a36Sopenharmony_ci snd_info_set_text_ops(entry, chip, 80862306a36Sopenharmony_ci cs46xx_dsp_proc_modules_read); 80962306a36Sopenharmony_ci 81062306a36Sopenharmony_ci entry = snd_info_create_card_entry(card, "parameter", 81162306a36Sopenharmony_ci ins->proc_dsp_dir); 81262306a36Sopenharmony_ci if (entry) 81362306a36Sopenharmony_ci snd_info_set_text_ops(entry, chip, 81462306a36Sopenharmony_ci cs46xx_dsp_proc_parameter_dump_read); 81562306a36Sopenharmony_ci 81662306a36Sopenharmony_ci entry = snd_info_create_card_entry(card, "sample", 81762306a36Sopenharmony_ci ins->proc_dsp_dir); 81862306a36Sopenharmony_ci if (entry) 81962306a36Sopenharmony_ci snd_info_set_text_ops(entry, chip, 82062306a36Sopenharmony_ci cs46xx_dsp_proc_sample_dump_read); 82162306a36Sopenharmony_ci 82262306a36Sopenharmony_ci entry = snd_info_create_card_entry(card, "task_tree", 82362306a36Sopenharmony_ci ins->proc_dsp_dir); 82462306a36Sopenharmony_ci if (entry) 82562306a36Sopenharmony_ci snd_info_set_text_ops(entry, chip, 82662306a36Sopenharmony_ci cs46xx_dsp_proc_task_tree_read); 82762306a36Sopenharmony_ci 82862306a36Sopenharmony_ci entry = snd_info_create_card_entry(card, "scb_info", 82962306a36Sopenharmony_ci ins->proc_dsp_dir); 83062306a36Sopenharmony_ci if (entry) 83162306a36Sopenharmony_ci snd_info_set_text_ops(entry, chip, 83262306a36Sopenharmony_ci cs46xx_dsp_proc_scb_read); 83362306a36Sopenharmony_ci 83462306a36Sopenharmony_ci mutex_lock(&chip->spos_mutex); 83562306a36Sopenharmony_ci /* register/update SCB's entries on proc */ 83662306a36Sopenharmony_ci for (i = 0; i < ins->nscb; ++i) { 83762306a36Sopenharmony_ci if (ins->scbs[i].deleted) continue; 83862306a36Sopenharmony_ci 83962306a36Sopenharmony_ci cs46xx_dsp_proc_register_scb_desc (chip, (ins->scbs + i)); 84062306a36Sopenharmony_ci } 84162306a36Sopenharmony_ci mutex_unlock(&chip->spos_mutex); 84262306a36Sopenharmony_ci 84362306a36Sopenharmony_ci return 0; 84462306a36Sopenharmony_ci} 84562306a36Sopenharmony_ci 84662306a36Sopenharmony_ciint cs46xx_dsp_proc_done (struct snd_cs46xx *chip) 84762306a36Sopenharmony_ci{ 84862306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 84962306a36Sopenharmony_ci int i; 85062306a36Sopenharmony_ci 85162306a36Sopenharmony_ci if (!ins) 85262306a36Sopenharmony_ci return 0; 85362306a36Sopenharmony_ci 85462306a36Sopenharmony_ci mutex_lock(&chip->spos_mutex); 85562306a36Sopenharmony_ci for (i = 0; i < ins->nscb; ++i) { 85662306a36Sopenharmony_ci if (ins->scbs[i].deleted) continue; 85762306a36Sopenharmony_ci cs46xx_dsp_proc_free_scb_desc ( (ins->scbs + i) ); 85862306a36Sopenharmony_ci } 85962306a36Sopenharmony_ci mutex_unlock(&chip->spos_mutex); 86062306a36Sopenharmony_ci 86162306a36Sopenharmony_ci snd_info_free_entry(ins->proc_dsp_dir); 86262306a36Sopenharmony_ci ins->proc_dsp_dir = NULL; 86362306a36Sopenharmony_ci 86462306a36Sopenharmony_ci return 0; 86562306a36Sopenharmony_ci} 86662306a36Sopenharmony_ci#endif /* CONFIG_SND_PROC_FS */ 86762306a36Sopenharmony_ci 86862306a36Sopenharmony_cistatic void _dsp_create_task_tree (struct snd_cs46xx *chip, u32 * task_data, 86962306a36Sopenharmony_ci u32 dest, int size) 87062306a36Sopenharmony_ci{ 87162306a36Sopenharmony_ci void __iomem *spdst = chip->region.idx[1].remap_addr + 87262306a36Sopenharmony_ci DSP_PARAMETER_BYTE_OFFSET + dest * sizeof(u32); 87362306a36Sopenharmony_ci int i; 87462306a36Sopenharmony_ci 87562306a36Sopenharmony_ci for (i = 0; i < size; ++i) { 87662306a36Sopenharmony_ci dev_dbg(chip->card->dev, "addr %p, val %08x\n", 87762306a36Sopenharmony_ci spdst, task_data[i]); 87862306a36Sopenharmony_ci writel(task_data[i],spdst); 87962306a36Sopenharmony_ci spdst += sizeof(u32); 88062306a36Sopenharmony_ci } 88162306a36Sopenharmony_ci} 88262306a36Sopenharmony_ci 88362306a36Sopenharmony_cistatic void _dsp_create_scb (struct snd_cs46xx *chip, u32 * scb_data, u32 dest) 88462306a36Sopenharmony_ci{ 88562306a36Sopenharmony_ci void __iomem *spdst = chip->region.idx[1].remap_addr + 88662306a36Sopenharmony_ci DSP_PARAMETER_BYTE_OFFSET + dest * sizeof(u32); 88762306a36Sopenharmony_ci int i; 88862306a36Sopenharmony_ci 88962306a36Sopenharmony_ci for (i = 0; i < 0x10; ++i) { 89062306a36Sopenharmony_ci dev_dbg(chip->card->dev, "addr %p, val %08x\n", 89162306a36Sopenharmony_ci spdst, scb_data[i]); 89262306a36Sopenharmony_ci writel(scb_data[i],spdst); 89362306a36Sopenharmony_ci spdst += sizeof(u32); 89462306a36Sopenharmony_ci } 89562306a36Sopenharmony_ci} 89662306a36Sopenharmony_ci 89762306a36Sopenharmony_cistatic int find_free_scb_index (struct dsp_spos_instance * ins) 89862306a36Sopenharmony_ci{ 89962306a36Sopenharmony_ci int index = ins->nscb, i; 90062306a36Sopenharmony_ci 90162306a36Sopenharmony_ci for (i = ins->scb_highest_frag_index; i < ins->nscb; ++i) { 90262306a36Sopenharmony_ci if (ins->scbs[i].deleted) { 90362306a36Sopenharmony_ci index = i; 90462306a36Sopenharmony_ci break; 90562306a36Sopenharmony_ci } 90662306a36Sopenharmony_ci } 90762306a36Sopenharmony_ci 90862306a36Sopenharmony_ci return index; 90962306a36Sopenharmony_ci} 91062306a36Sopenharmony_ci 91162306a36Sopenharmony_cistatic struct dsp_scb_descriptor * _map_scb (struct snd_cs46xx *chip, char * name, u32 dest) 91262306a36Sopenharmony_ci{ 91362306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 91462306a36Sopenharmony_ci struct dsp_scb_descriptor * desc = NULL; 91562306a36Sopenharmony_ci int index; 91662306a36Sopenharmony_ci 91762306a36Sopenharmony_ci if (ins->nscb == DSP_MAX_SCB_DESC - 1) { 91862306a36Sopenharmony_ci dev_err(chip->card->dev, 91962306a36Sopenharmony_ci "dsp_spos: got no place for other SCB\n"); 92062306a36Sopenharmony_ci return NULL; 92162306a36Sopenharmony_ci } 92262306a36Sopenharmony_ci 92362306a36Sopenharmony_ci index = find_free_scb_index (ins); 92462306a36Sopenharmony_ci 92562306a36Sopenharmony_ci memset(&ins->scbs[index], 0, sizeof(ins->scbs[index])); 92662306a36Sopenharmony_ci strcpy(ins->scbs[index].scb_name, name); 92762306a36Sopenharmony_ci ins->scbs[index].address = dest; 92862306a36Sopenharmony_ci ins->scbs[index].index = index; 92962306a36Sopenharmony_ci ins->scbs[index].ref_count = 1; 93062306a36Sopenharmony_ci 93162306a36Sopenharmony_ci desc = (ins->scbs + index); 93262306a36Sopenharmony_ci ins->scbs[index].scb_symbol = add_symbol (chip, name, dest, SYMBOL_PARAMETER); 93362306a36Sopenharmony_ci 93462306a36Sopenharmony_ci if (index > ins->scb_highest_frag_index) 93562306a36Sopenharmony_ci ins->scb_highest_frag_index = index; 93662306a36Sopenharmony_ci 93762306a36Sopenharmony_ci if (index == ins->nscb) 93862306a36Sopenharmony_ci ins->nscb++; 93962306a36Sopenharmony_ci 94062306a36Sopenharmony_ci return desc; 94162306a36Sopenharmony_ci} 94262306a36Sopenharmony_ci 94362306a36Sopenharmony_cistatic struct dsp_task_descriptor * 94462306a36Sopenharmony_ci_map_task_tree (struct snd_cs46xx *chip, char * name, u32 dest, u32 size) 94562306a36Sopenharmony_ci{ 94662306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 94762306a36Sopenharmony_ci struct dsp_task_descriptor * desc = NULL; 94862306a36Sopenharmony_ci 94962306a36Sopenharmony_ci if (ins->ntask == DSP_MAX_TASK_DESC - 1) { 95062306a36Sopenharmony_ci dev_err(chip->card->dev, 95162306a36Sopenharmony_ci "dsp_spos: got no place for other TASK\n"); 95262306a36Sopenharmony_ci return NULL; 95362306a36Sopenharmony_ci } 95462306a36Sopenharmony_ci 95562306a36Sopenharmony_ci if (name) 95662306a36Sopenharmony_ci strcpy(ins->tasks[ins->ntask].task_name, name); 95762306a36Sopenharmony_ci else 95862306a36Sopenharmony_ci strcpy(ins->tasks[ins->ntask].task_name, "(NULL)"); 95962306a36Sopenharmony_ci ins->tasks[ins->ntask].address = dest; 96062306a36Sopenharmony_ci ins->tasks[ins->ntask].size = size; 96162306a36Sopenharmony_ci 96262306a36Sopenharmony_ci /* quick find in list */ 96362306a36Sopenharmony_ci ins->tasks[ins->ntask].index = ins->ntask; 96462306a36Sopenharmony_ci desc = (ins->tasks + ins->ntask); 96562306a36Sopenharmony_ci ins->ntask++; 96662306a36Sopenharmony_ci 96762306a36Sopenharmony_ci if (name) 96862306a36Sopenharmony_ci add_symbol (chip,name,dest,SYMBOL_PARAMETER); 96962306a36Sopenharmony_ci return desc; 97062306a36Sopenharmony_ci} 97162306a36Sopenharmony_ci 97262306a36Sopenharmony_ci#define SCB_BYTES (0x10 * 4) 97362306a36Sopenharmony_ci 97462306a36Sopenharmony_cistruct dsp_scb_descriptor * 97562306a36Sopenharmony_cics46xx_dsp_create_scb (struct snd_cs46xx *chip, char * name, u32 * scb_data, u32 dest) 97662306a36Sopenharmony_ci{ 97762306a36Sopenharmony_ci struct dsp_scb_descriptor * desc; 97862306a36Sopenharmony_ci 97962306a36Sopenharmony_ci#ifdef CONFIG_PM_SLEEP 98062306a36Sopenharmony_ci /* copy the data for resume */ 98162306a36Sopenharmony_ci scb_data = kmemdup(scb_data, SCB_BYTES, GFP_KERNEL); 98262306a36Sopenharmony_ci if (!scb_data) 98362306a36Sopenharmony_ci return NULL; 98462306a36Sopenharmony_ci#endif 98562306a36Sopenharmony_ci 98662306a36Sopenharmony_ci desc = _map_scb (chip,name,dest); 98762306a36Sopenharmony_ci if (desc) { 98862306a36Sopenharmony_ci desc->data = scb_data; 98962306a36Sopenharmony_ci _dsp_create_scb(chip,scb_data,dest); 99062306a36Sopenharmony_ci } else { 99162306a36Sopenharmony_ci dev_err(chip->card->dev, "dsp_spos: failed to map SCB\n"); 99262306a36Sopenharmony_ci#ifdef CONFIG_PM_SLEEP 99362306a36Sopenharmony_ci kfree(scb_data); 99462306a36Sopenharmony_ci#endif 99562306a36Sopenharmony_ci } 99662306a36Sopenharmony_ci 99762306a36Sopenharmony_ci return desc; 99862306a36Sopenharmony_ci} 99962306a36Sopenharmony_ci 100062306a36Sopenharmony_ci 100162306a36Sopenharmony_cistatic struct dsp_task_descriptor * 100262306a36Sopenharmony_cics46xx_dsp_create_task_tree (struct snd_cs46xx *chip, char * name, u32 * task_data, 100362306a36Sopenharmony_ci u32 dest, int size) 100462306a36Sopenharmony_ci{ 100562306a36Sopenharmony_ci struct dsp_task_descriptor * desc; 100662306a36Sopenharmony_ci 100762306a36Sopenharmony_ci desc = _map_task_tree (chip,name,dest,size); 100862306a36Sopenharmony_ci if (desc) { 100962306a36Sopenharmony_ci desc->data = task_data; 101062306a36Sopenharmony_ci _dsp_create_task_tree(chip,task_data,dest,size); 101162306a36Sopenharmony_ci } else { 101262306a36Sopenharmony_ci dev_err(chip->card->dev, "dsp_spos: failed to map TASK\n"); 101362306a36Sopenharmony_ci } 101462306a36Sopenharmony_ci 101562306a36Sopenharmony_ci return desc; 101662306a36Sopenharmony_ci} 101762306a36Sopenharmony_ci 101862306a36Sopenharmony_ciint cs46xx_dsp_scb_and_task_init (struct snd_cs46xx *chip) 101962306a36Sopenharmony_ci{ 102062306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 102162306a36Sopenharmony_ci struct dsp_symbol_entry * fg_task_tree_header_code; 102262306a36Sopenharmony_ci struct dsp_symbol_entry * task_tree_header_code; 102362306a36Sopenharmony_ci struct dsp_symbol_entry * task_tree_thread; 102462306a36Sopenharmony_ci struct dsp_symbol_entry * null_algorithm; 102562306a36Sopenharmony_ci struct dsp_symbol_entry * magic_snoop_task; 102662306a36Sopenharmony_ci 102762306a36Sopenharmony_ci struct dsp_scb_descriptor * timing_master_scb; 102862306a36Sopenharmony_ci struct dsp_scb_descriptor * codec_out_scb; 102962306a36Sopenharmony_ci struct dsp_scb_descriptor * codec_in_scb; 103062306a36Sopenharmony_ci struct dsp_scb_descriptor * src_task_scb; 103162306a36Sopenharmony_ci struct dsp_scb_descriptor * master_mix_scb; 103262306a36Sopenharmony_ci struct dsp_scb_descriptor * rear_mix_scb; 103362306a36Sopenharmony_ci struct dsp_scb_descriptor * record_mix_scb; 103462306a36Sopenharmony_ci struct dsp_scb_descriptor * write_back_scb; 103562306a36Sopenharmony_ci struct dsp_scb_descriptor * vari_decimate_scb; 103662306a36Sopenharmony_ci struct dsp_scb_descriptor * rear_codec_out_scb; 103762306a36Sopenharmony_ci struct dsp_scb_descriptor * clfe_codec_out_scb; 103862306a36Sopenharmony_ci struct dsp_scb_descriptor * magic_snoop_scb; 103962306a36Sopenharmony_ci 104062306a36Sopenharmony_ci int fifo_addr, fifo_span, valid_slots; 104162306a36Sopenharmony_ci 104262306a36Sopenharmony_ci static const struct dsp_spos_control_block sposcb = { 104362306a36Sopenharmony_ci /* 0 */ HFG_TREE_SCB,HFG_STACK, 104462306a36Sopenharmony_ci /* 1 */ SPOSCB_ADDR,BG_TREE_SCB_ADDR, 104562306a36Sopenharmony_ci /* 2 */ DSP_SPOS_DC,0, 104662306a36Sopenharmony_ci /* 3 */ DSP_SPOS_DC,DSP_SPOS_DC, 104762306a36Sopenharmony_ci /* 4 */ 0,0, 104862306a36Sopenharmony_ci /* 5 */ DSP_SPOS_UU,0, 104962306a36Sopenharmony_ci /* 6 */ FG_TASK_HEADER_ADDR,0, 105062306a36Sopenharmony_ci /* 7 */ 0,0, 105162306a36Sopenharmony_ci /* 8 */ DSP_SPOS_UU,DSP_SPOS_DC, 105262306a36Sopenharmony_ci /* 9 */ 0, 105362306a36Sopenharmony_ci /* A */ 0,HFG_FIRST_EXECUTE_MODE, 105462306a36Sopenharmony_ci /* B */ DSP_SPOS_UU,DSP_SPOS_UU, 105562306a36Sopenharmony_ci /* C */ DSP_SPOS_DC_DC, 105662306a36Sopenharmony_ci /* D */ DSP_SPOS_DC_DC, 105762306a36Sopenharmony_ci /* E */ DSP_SPOS_DC_DC, 105862306a36Sopenharmony_ci /* F */ DSP_SPOS_DC_DC 105962306a36Sopenharmony_ci }; 106062306a36Sopenharmony_ci 106162306a36Sopenharmony_ci cs46xx_dsp_create_task_tree(chip, "sposCB", (u32 *)&sposcb, SPOSCB_ADDR, 0x10); 106262306a36Sopenharmony_ci 106362306a36Sopenharmony_ci null_algorithm = cs46xx_dsp_lookup_symbol(chip, "NULLALGORITHM", SYMBOL_CODE); 106462306a36Sopenharmony_ci if (null_algorithm == NULL) { 106562306a36Sopenharmony_ci dev_err(chip->card->dev, 106662306a36Sopenharmony_ci "dsp_spos: symbol NULLALGORITHM not found\n"); 106762306a36Sopenharmony_ci return -EIO; 106862306a36Sopenharmony_ci } 106962306a36Sopenharmony_ci 107062306a36Sopenharmony_ci fg_task_tree_header_code = cs46xx_dsp_lookup_symbol(chip, "FGTASKTREEHEADERCODE", SYMBOL_CODE); 107162306a36Sopenharmony_ci if (fg_task_tree_header_code == NULL) { 107262306a36Sopenharmony_ci dev_err(chip->card->dev, 107362306a36Sopenharmony_ci "dsp_spos: symbol FGTASKTREEHEADERCODE not found\n"); 107462306a36Sopenharmony_ci return -EIO; 107562306a36Sopenharmony_ci } 107662306a36Sopenharmony_ci 107762306a36Sopenharmony_ci task_tree_header_code = cs46xx_dsp_lookup_symbol(chip, "TASKTREEHEADERCODE", SYMBOL_CODE); 107862306a36Sopenharmony_ci if (task_tree_header_code == NULL) { 107962306a36Sopenharmony_ci dev_err(chip->card->dev, 108062306a36Sopenharmony_ci "dsp_spos: symbol TASKTREEHEADERCODE not found\n"); 108162306a36Sopenharmony_ci return -EIO; 108262306a36Sopenharmony_ci } 108362306a36Sopenharmony_ci 108462306a36Sopenharmony_ci task_tree_thread = cs46xx_dsp_lookup_symbol(chip, "TASKTREETHREAD", SYMBOL_CODE); 108562306a36Sopenharmony_ci if (task_tree_thread == NULL) { 108662306a36Sopenharmony_ci dev_err(chip->card->dev, 108762306a36Sopenharmony_ci "dsp_spos: symbol TASKTREETHREAD not found\n"); 108862306a36Sopenharmony_ci return -EIO; 108962306a36Sopenharmony_ci } 109062306a36Sopenharmony_ci 109162306a36Sopenharmony_ci magic_snoop_task = cs46xx_dsp_lookup_symbol(chip, "MAGICSNOOPTASK", SYMBOL_CODE); 109262306a36Sopenharmony_ci if (magic_snoop_task == NULL) { 109362306a36Sopenharmony_ci dev_err(chip->card->dev, 109462306a36Sopenharmony_ci "dsp_spos: symbol MAGICSNOOPTASK not found\n"); 109562306a36Sopenharmony_ci return -EIO; 109662306a36Sopenharmony_ci } 109762306a36Sopenharmony_ci 109862306a36Sopenharmony_ci { 109962306a36Sopenharmony_ci /* create the null SCB */ 110062306a36Sopenharmony_ci static struct dsp_generic_scb null_scb = { 110162306a36Sopenharmony_ci { 0, 0, 0, 0 }, 110262306a36Sopenharmony_ci { 0, 0, 0, 0, 0 }, 110362306a36Sopenharmony_ci NULL_SCB_ADDR, NULL_SCB_ADDR, 110462306a36Sopenharmony_ci 0, 0, 0, 0, 0, 110562306a36Sopenharmony_ci { 110662306a36Sopenharmony_ci 0,0, 110762306a36Sopenharmony_ci 0,0, 110862306a36Sopenharmony_ci } 110962306a36Sopenharmony_ci }; 111062306a36Sopenharmony_ci 111162306a36Sopenharmony_ci null_scb.entry_point = null_algorithm->address; 111262306a36Sopenharmony_ci ins->the_null_scb = cs46xx_dsp_create_scb(chip, "nullSCB", (u32 *)&null_scb, NULL_SCB_ADDR); 111362306a36Sopenharmony_ci ins->the_null_scb->task_entry = null_algorithm; 111462306a36Sopenharmony_ci ins->the_null_scb->sub_list_ptr = ins->the_null_scb; 111562306a36Sopenharmony_ci ins->the_null_scb->next_scb_ptr = ins->the_null_scb; 111662306a36Sopenharmony_ci ins->the_null_scb->parent_scb_ptr = NULL; 111762306a36Sopenharmony_ci cs46xx_dsp_proc_register_scb_desc (chip,ins->the_null_scb); 111862306a36Sopenharmony_ci } 111962306a36Sopenharmony_ci 112062306a36Sopenharmony_ci { 112162306a36Sopenharmony_ci /* setup foreground task tree */ 112262306a36Sopenharmony_ci static struct dsp_task_tree_control_block fg_task_tree_hdr = { 112362306a36Sopenharmony_ci { FG_TASK_HEADER_ADDR | (DSP_SPOS_DC << 0x10), 112462306a36Sopenharmony_ci DSP_SPOS_DC_DC, 112562306a36Sopenharmony_ci DSP_SPOS_DC_DC, 112662306a36Sopenharmony_ci 0x0000,DSP_SPOS_DC, 112762306a36Sopenharmony_ci DSP_SPOS_DC, DSP_SPOS_DC, 112862306a36Sopenharmony_ci DSP_SPOS_DC_DC, 112962306a36Sopenharmony_ci DSP_SPOS_DC_DC, 113062306a36Sopenharmony_ci DSP_SPOS_DC_DC, 113162306a36Sopenharmony_ci DSP_SPOS_DC,DSP_SPOS_DC }, 113262306a36Sopenharmony_ci 113362306a36Sopenharmony_ci { 113462306a36Sopenharmony_ci BG_TREE_SCB_ADDR,TIMINGMASTER_SCB_ADDR, 113562306a36Sopenharmony_ci 0, 113662306a36Sopenharmony_ci FG_TASK_HEADER_ADDR + TCBData, 113762306a36Sopenharmony_ci }, 113862306a36Sopenharmony_ci 113962306a36Sopenharmony_ci { 114062306a36Sopenharmony_ci 4,0, 114162306a36Sopenharmony_ci 1,0, 114262306a36Sopenharmony_ci 2,SPOSCB_ADDR + HFGFlags, 114362306a36Sopenharmony_ci 0,0, 114462306a36Sopenharmony_ci FG_TASK_HEADER_ADDR + TCBContextBlk,FG_STACK 114562306a36Sopenharmony_ci }, 114662306a36Sopenharmony_ci 114762306a36Sopenharmony_ci { 114862306a36Sopenharmony_ci DSP_SPOS_DC,0, 114962306a36Sopenharmony_ci DSP_SPOS_DC,DSP_SPOS_DC, 115062306a36Sopenharmony_ci DSP_SPOS_DC,DSP_SPOS_DC, 115162306a36Sopenharmony_ci DSP_SPOS_DC,DSP_SPOS_DC, 115262306a36Sopenharmony_ci DSP_SPOS_DC,DSP_SPOS_DC, 115362306a36Sopenharmony_ci DSP_SPOS_DCDC, 115462306a36Sopenharmony_ci DSP_SPOS_UU,1, 115562306a36Sopenharmony_ci DSP_SPOS_DCDC, 115662306a36Sopenharmony_ci DSP_SPOS_DCDC, 115762306a36Sopenharmony_ci DSP_SPOS_DCDC, 115862306a36Sopenharmony_ci DSP_SPOS_DCDC, 115962306a36Sopenharmony_ci DSP_SPOS_DCDC, 116062306a36Sopenharmony_ci DSP_SPOS_DCDC, 116162306a36Sopenharmony_ci DSP_SPOS_DCDC, 116262306a36Sopenharmony_ci DSP_SPOS_DCDC, 116362306a36Sopenharmony_ci DSP_SPOS_DCDC, 116462306a36Sopenharmony_ci DSP_SPOS_DCDC, 116562306a36Sopenharmony_ci DSP_SPOS_DCDC, 116662306a36Sopenharmony_ci DSP_SPOS_DCDC, 116762306a36Sopenharmony_ci DSP_SPOS_DCDC, 116862306a36Sopenharmony_ci DSP_SPOS_DCDC, 116962306a36Sopenharmony_ci DSP_SPOS_DCDC, 117062306a36Sopenharmony_ci DSP_SPOS_DCDC, 117162306a36Sopenharmony_ci DSP_SPOS_DCDC, 117262306a36Sopenharmony_ci DSP_SPOS_DCDC, 117362306a36Sopenharmony_ci DSP_SPOS_DCDC, 117462306a36Sopenharmony_ci DSP_SPOS_DCDC, 117562306a36Sopenharmony_ci DSP_SPOS_DCDC, 117662306a36Sopenharmony_ci DSP_SPOS_DCDC, 117762306a36Sopenharmony_ci DSP_SPOS_DCDC, 117862306a36Sopenharmony_ci DSP_SPOS_DCDC, 117962306a36Sopenharmony_ci DSP_SPOS_DCDC, 118062306a36Sopenharmony_ci DSP_SPOS_DCDC, 118162306a36Sopenharmony_ci DSP_SPOS_DCDC, 118262306a36Sopenharmony_ci DSP_SPOS_DCDC 118362306a36Sopenharmony_ci }, 118462306a36Sopenharmony_ci { 118562306a36Sopenharmony_ci FG_INTERVAL_TIMER_PERIOD,DSP_SPOS_UU, 118662306a36Sopenharmony_ci 0,0 118762306a36Sopenharmony_ci } 118862306a36Sopenharmony_ci }; 118962306a36Sopenharmony_ci 119062306a36Sopenharmony_ci fg_task_tree_hdr.links.entry_point = fg_task_tree_header_code->address; 119162306a36Sopenharmony_ci fg_task_tree_hdr.context_blk.stack0 = task_tree_thread->address; 119262306a36Sopenharmony_ci cs46xx_dsp_create_task_tree(chip,"FGtaskTreeHdr",(u32 *)&fg_task_tree_hdr,FG_TASK_HEADER_ADDR,0x35); 119362306a36Sopenharmony_ci } 119462306a36Sopenharmony_ci 119562306a36Sopenharmony_ci 119662306a36Sopenharmony_ci { 119762306a36Sopenharmony_ci /* setup foreground task tree */ 119862306a36Sopenharmony_ci static struct dsp_task_tree_control_block bg_task_tree_hdr = { 119962306a36Sopenharmony_ci { DSP_SPOS_DC_DC, 120062306a36Sopenharmony_ci DSP_SPOS_DC_DC, 120162306a36Sopenharmony_ci DSP_SPOS_DC_DC, 120262306a36Sopenharmony_ci DSP_SPOS_DC, DSP_SPOS_DC, 120362306a36Sopenharmony_ci DSP_SPOS_DC, DSP_SPOS_DC, 120462306a36Sopenharmony_ci DSP_SPOS_DC_DC, 120562306a36Sopenharmony_ci DSP_SPOS_DC_DC, 120662306a36Sopenharmony_ci DSP_SPOS_DC_DC, 120762306a36Sopenharmony_ci DSP_SPOS_DC,DSP_SPOS_DC }, 120862306a36Sopenharmony_ci 120962306a36Sopenharmony_ci { 121062306a36Sopenharmony_ci NULL_SCB_ADDR,NULL_SCB_ADDR, /* Set up the background to do nothing */ 121162306a36Sopenharmony_ci 0, 121262306a36Sopenharmony_ci BG_TREE_SCB_ADDR + TCBData, 121362306a36Sopenharmony_ci }, 121462306a36Sopenharmony_ci 121562306a36Sopenharmony_ci { 121662306a36Sopenharmony_ci 9999,0, 121762306a36Sopenharmony_ci 0,1, 121862306a36Sopenharmony_ci 0,SPOSCB_ADDR + HFGFlags, 121962306a36Sopenharmony_ci 0,0, 122062306a36Sopenharmony_ci BG_TREE_SCB_ADDR + TCBContextBlk,BG_STACK 122162306a36Sopenharmony_ci }, 122262306a36Sopenharmony_ci 122362306a36Sopenharmony_ci { 122462306a36Sopenharmony_ci DSP_SPOS_DC,0, 122562306a36Sopenharmony_ci DSP_SPOS_DC,DSP_SPOS_DC, 122662306a36Sopenharmony_ci DSP_SPOS_DC,DSP_SPOS_DC, 122762306a36Sopenharmony_ci DSP_SPOS_DC,DSP_SPOS_DC, 122862306a36Sopenharmony_ci DSP_SPOS_DC,DSP_SPOS_DC, 122962306a36Sopenharmony_ci DSP_SPOS_DCDC, 123062306a36Sopenharmony_ci DSP_SPOS_UU,1, 123162306a36Sopenharmony_ci DSP_SPOS_DCDC, 123262306a36Sopenharmony_ci DSP_SPOS_DCDC, 123362306a36Sopenharmony_ci DSP_SPOS_DCDC, 123462306a36Sopenharmony_ci DSP_SPOS_DCDC, 123562306a36Sopenharmony_ci DSP_SPOS_DCDC, 123662306a36Sopenharmony_ci DSP_SPOS_DCDC, 123762306a36Sopenharmony_ci DSP_SPOS_DCDC, 123862306a36Sopenharmony_ci DSP_SPOS_DCDC, 123962306a36Sopenharmony_ci DSP_SPOS_DCDC, 124062306a36Sopenharmony_ci DSP_SPOS_DCDC, 124162306a36Sopenharmony_ci DSP_SPOS_DCDC, 124262306a36Sopenharmony_ci DSP_SPOS_DCDC, 124362306a36Sopenharmony_ci DSP_SPOS_DCDC, 124462306a36Sopenharmony_ci DSP_SPOS_DCDC, 124562306a36Sopenharmony_ci DSP_SPOS_DCDC, 124662306a36Sopenharmony_ci DSP_SPOS_DCDC, 124762306a36Sopenharmony_ci DSP_SPOS_DCDC, 124862306a36Sopenharmony_ci DSP_SPOS_DCDC, 124962306a36Sopenharmony_ci DSP_SPOS_DCDC, 125062306a36Sopenharmony_ci DSP_SPOS_DCDC, 125162306a36Sopenharmony_ci DSP_SPOS_DCDC, 125262306a36Sopenharmony_ci DSP_SPOS_DCDC, 125362306a36Sopenharmony_ci DSP_SPOS_DCDC, 125462306a36Sopenharmony_ci DSP_SPOS_DCDC, 125562306a36Sopenharmony_ci DSP_SPOS_DCDC, 125662306a36Sopenharmony_ci DSP_SPOS_DCDC, 125762306a36Sopenharmony_ci DSP_SPOS_DCDC, 125862306a36Sopenharmony_ci DSP_SPOS_DCDC 125962306a36Sopenharmony_ci }, 126062306a36Sopenharmony_ci { 126162306a36Sopenharmony_ci BG_INTERVAL_TIMER_PERIOD,DSP_SPOS_UU, 126262306a36Sopenharmony_ci 0,0 126362306a36Sopenharmony_ci } 126462306a36Sopenharmony_ci }; 126562306a36Sopenharmony_ci 126662306a36Sopenharmony_ci bg_task_tree_hdr.links.entry_point = task_tree_header_code->address; 126762306a36Sopenharmony_ci bg_task_tree_hdr.context_blk.stack0 = task_tree_thread->address; 126862306a36Sopenharmony_ci cs46xx_dsp_create_task_tree(chip,"BGtaskTreeHdr",(u32 *)&bg_task_tree_hdr,BG_TREE_SCB_ADDR,0x35); 126962306a36Sopenharmony_ci } 127062306a36Sopenharmony_ci 127162306a36Sopenharmony_ci /* create timing master SCB */ 127262306a36Sopenharmony_ci timing_master_scb = cs46xx_dsp_create_timing_master_scb(chip); 127362306a36Sopenharmony_ci 127462306a36Sopenharmony_ci /* create the CODEC output task */ 127562306a36Sopenharmony_ci codec_out_scb = cs46xx_dsp_create_codec_out_scb(chip,"CodecOutSCB_I",0x0010,0x0000, 127662306a36Sopenharmony_ci MASTERMIX_SCB_ADDR, 127762306a36Sopenharmony_ci CODECOUT_SCB_ADDR,timing_master_scb, 127862306a36Sopenharmony_ci SCB_ON_PARENT_SUBLIST_SCB); 127962306a36Sopenharmony_ci 128062306a36Sopenharmony_ci if (!codec_out_scb) goto _fail_end; 128162306a36Sopenharmony_ci /* create the master mix SCB */ 128262306a36Sopenharmony_ci master_mix_scb = cs46xx_dsp_create_mix_only_scb(chip,"MasterMixSCB", 128362306a36Sopenharmony_ci MIX_SAMPLE_BUF1,MASTERMIX_SCB_ADDR, 128462306a36Sopenharmony_ci codec_out_scb, 128562306a36Sopenharmony_ci SCB_ON_PARENT_SUBLIST_SCB); 128662306a36Sopenharmony_ci ins->master_mix_scb = master_mix_scb; 128762306a36Sopenharmony_ci 128862306a36Sopenharmony_ci if (!master_mix_scb) goto _fail_end; 128962306a36Sopenharmony_ci 129062306a36Sopenharmony_ci /* create codec in */ 129162306a36Sopenharmony_ci codec_in_scb = cs46xx_dsp_create_codec_in_scb(chip,"CodecInSCB",0x0010,0x00A0, 129262306a36Sopenharmony_ci CODEC_INPUT_BUF1, 129362306a36Sopenharmony_ci CODECIN_SCB_ADDR,codec_out_scb, 129462306a36Sopenharmony_ci SCB_ON_PARENT_NEXT_SCB); 129562306a36Sopenharmony_ci if (!codec_in_scb) goto _fail_end; 129662306a36Sopenharmony_ci ins->codec_in_scb = codec_in_scb; 129762306a36Sopenharmony_ci 129862306a36Sopenharmony_ci /* create write back scb */ 129962306a36Sopenharmony_ci write_back_scb = cs46xx_dsp_create_mix_to_ostream_scb(chip,"WriteBackSCB", 130062306a36Sopenharmony_ci WRITE_BACK_BUF1,WRITE_BACK_SPB, 130162306a36Sopenharmony_ci WRITEBACK_SCB_ADDR, 130262306a36Sopenharmony_ci timing_master_scb, 130362306a36Sopenharmony_ci SCB_ON_PARENT_NEXT_SCB); 130462306a36Sopenharmony_ci if (!write_back_scb) goto _fail_end; 130562306a36Sopenharmony_ci 130662306a36Sopenharmony_ci { 130762306a36Sopenharmony_ci static struct dsp_mix2_ostream_spb mix2_ostream_spb = { 130862306a36Sopenharmony_ci 0x00020000, 130962306a36Sopenharmony_ci 0x0000ffff 131062306a36Sopenharmony_ci }; 131162306a36Sopenharmony_ci 131262306a36Sopenharmony_ci if (!cs46xx_dsp_create_task_tree(chip, NULL, 131362306a36Sopenharmony_ci (u32 *)&mix2_ostream_spb, 131462306a36Sopenharmony_ci WRITE_BACK_SPB, 2)) 131562306a36Sopenharmony_ci goto _fail_end; 131662306a36Sopenharmony_ci } 131762306a36Sopenharmony_ci 131862306a36Sopenharmony_ci /* input sample converter */ 131962306a36Sopenharmony_ci vari_decimate_scb = cs46xx_dsp_create_vari_decimate_scb(chip,"VariDecimateSCB", 132062306a36Sopenharmony_ci VARI_DECIMATE_BUF0, 132162306a36Sopenharmony_ci VARI_DECIMATE_BUF1, 132262306a36Sopenharmony_ci VARIDECIMATE_SCB_ADDR, 132362306a36Sopenharmony_ci write_back_scb, 132462306a36Sopenharmony_ci SCB_ON_PARENT_SUBLIST_SCB); 132562306a36Sopenharmony_ci if (!vari_decimate_scb) goto _fail_end; 132662306a36Sopenharmony_ci 132762306a36Sopenharmony_ci /* create the record mixer SCB */ 132862306a36Sopenharmony_ci record_mix_scb = cs46xx_dsp_create_mix_only_scb(chip,"RecordMixerSCB", 132962306a36Sopenharmony_ci MIX_SAMPLE_BUF2, 133062306a36Sopenharmony_ci RECORD_MIXER_SCB_ADDR, 133162306a36Sopenharmony_ci vari_decimate_scb, 133262306a36Sopenharmony_ci SCB_ON_PARENT_SUBLIST_SCB); 133362306a36Sopenharmony_ci ins->record_mixer_scb = record_mix_scb; 133462306a36Sopenharmony_ci 133562306a36Sopenharmony_ci if (!record_mix_scb) goto _fail_end; 133662306a36Sopenharmony_ci 133762306a36Sopenharmony_ci valid_slots = snd_cs46xx_peekBA0(chip, BA0_ACOSV); 133862306a36Sopenharmony_ci 133962306a36Sopenharmony_ci if (snd_BUG_ON(chip->nr_ac97_codecs != 1 && chip->nr_ac97_codecs != 2)) 134062306a36Sopenharmony_ci goto _fail_end; 134162306a36Sopenharmony_ci 134262306a36Sopenharmony_ci if (chip->nr_ac97_codecs == 1) { 134362306a36Sopenharmony_ci /* output on slot 5 and 11 134462306a36Sopenharmony_ci on primary CODEC */ 134562306a36Sopenharmony_ci fifo_addr = 0x20; 134662306a36Sopenharmony_ci fifo_span = 0x60; 134762306a36Sopenharmony_ci 134862306a36Sopenharmony_ci /* enable slot 5 and 11 */ 134962306a36Sopenharmony_ci valid_slots |= ACOSV_SLV5 | ACOSV_SLV11; 135062306a36Sopenharmony_ci } else { 135162306a36Sopenharmony_ci /* output on slot 7 and 8 135262306a36Sopenharmony_ci on secondary CODEC */ 135362306a36Sopenharmony_ci fifo_addr = 0x40; 135462306a36Sopenharmony_ci fifo_span = 0x10; 135562306a36Sopenharmony_ci 135662306a36Sopenharmony_ci /* enable slot 7 and 8 */ 135762306a36Sopenharmony_ci valid_slots |= ACOSV_SLV7 | ACOSV_SLV8; 135862306a36Sopenharmony_ci } 135962306a36Sopenharmony_ci /* create CODEC tasklet for rear speakers output*/ 136062306a36Sopenharmony_ci rear_codec_out_scb = cs46xx_dsp_create_codec_out_scb(chip,"CodecOutSCB_Rear",fifo_span,fifo_addr, 136162306a36Sopenharmony_ci REAR_MIXER_SCB_ADDR, 136262306a36Sopenharmony_ci REAR_CODECOUT_SCB_ADDR,codec_in_scb, 136362306a36Sopenharmony_ci SCB_ON_PARENT_NEXT_SCB); 136462306a36Sopenharmony_ci if (!rear_codec_out_scb) goto _fail_end; 136562306a36Sopenharmony_ci 136662306a36Sopenharmony_ci 136762306a36Sopenharmony_ci /* create the rear PCM channel mixer SCB */ 136862306a36Sopenharmony_ci rear_mix_scb = cs46xx_dsp_create_mix_only_scb(chip,"RearMixerSCB", 136962306a36Sopenharmony_ci MIX_SAMPLE_BUF3, 137062306a36Sopenharmony_ci REAR_MIXER_SCB_ADDR, 137162306a36Sopenharmony_ci rear_codec_out_scb, 137262306a36Sopenharmony_ci SCB_ON_PARENT_SUBLIST_SCB); 137362306a36Sopenharmony_ci ins->rear_mix_scb = rear_mix_scb; 137462306a36Sopenharmony_ci if (!rear_mix_scb) goto _fail_end; 137562306a36Sopenharmony_ci 137662306a36Sopenharmony_ci if (chip->nr_ac97_codecs == 2) { 137762306a36Sopenharmony_ci /* create CODEC tasklet for rear Center/LFE output 137862306a36Sopenharmony_ci slot 6 and 9 on secondary CODEC */ 137962306a36Sopenharmony_ci clfe_codec_out_scb = cs46xx_dsp_create_codec_out_scb(chip,"CodecOutSCB_CLFE",0x0030,0x0030, 138062306a36Sopenharmony_ci CLFE_MIXER_SCB_ADDR, 138162306a36Sopenharmony_ci CLFE_CODEC_SCB_ADDR, 138262306a36Sopenharmony_ci rear_codec_out_scb, 138362306a36Sopenharmony_ci SCB_ON_PARENT_NEXT_SCB); 138462306a36Sopenharmony_ci if (!clfe_codec_out_scb) goto _fail_end; 138562306a36Sopenharmony_ci 138662306a36Sopenharmony_ci 138762306a36Sopenharmony_ci /* create the rear PCM channel mixer SCB */ 138862306a36Sopenharmony_ci ins->center_lfe_mix_scb = cs46xx_dsp_create_mix_only_scb(chip,"CLFEMixerSCB", 138962306a36Sopenharmony_ci MIX_SAMPLE_BUF4, 139062306a36Sopenharmony_ci CLFE_MIXER_SCB_ADDR, 139162306a36Sopenharmony_ci clfe_codec_out_scb, 139262306a36Sopenharmony_ci SCB_ON_PARENT_SUBLIST_SCB); 139362306a36Sopenharmony_ci if (!ins->center_lfe_mix_scb) goto _fail_end; 139462306a36Sopenharmony_ci 139562306a36Sopenharmony_ci /* enable slot 6 and 9 */ 139662306a36Sopenharmony_ci valid_slots |= ACOSV_SLV6 | ACOSV_SLV9; 139762306a36Sopenharmony_ci } else { 139862306a36Sopenharmony_ci clfe_codec_out_scb = rear_codec_out_scb; 139962306a36Sopenharmony_ci ins->center_lfe_mix_scb = rear_mix_scb; 140062306a36Sopenharmony_ci } 140162306a36Sopenharmony_ci 140262306a36Sopenharmony_ci /* enable slots depending on CODEC configuration */ 140362306a36Sopenharmony_ci snd_cs46xx_pokeBA0(chip, BA0_ACOSV, valid_slots); 140462306a36Sopenharmony_ci 140562306a36Sopenharmony_ci /* the magic snooper */ 140662306a36Sopenharmony_ci magic_snoop_scb = cs46xx_dsp_create_magic_snoop_scb (chip,"MagicSnoopSCB_I",OUTPUTSNOOP_SCB_ADDR, 140762306a36Sopenharmony_ci OUTPUT_SNOOP_BUFFER, 140862306a36Sopenharmony_ci codec_out_scb, 140962306a36Sopenharmony_ci clfe_codec_out_scb, 141062306a36Sopenharmony_ci SCB_ON_PARENT_NEXT_SCB); 141162306a36Sopenharmony_ci 141262306a36Sopenharmony_ci 141362306a36Sopenharmony_ci if (!magic_snoop_scb) goto _fail_end; 141462306a36Sopenharmony_ci ins->ref_snoop_scb = magic_snoop_scb; 141562306a36Sopenharmony_ci 141662306a36Sopenharmony_ci /* SP IO access */ 141762306a36Sopenharmony_ci if (!cs46xx_dsp_create_spio_write_scb(chip,"SPIOWriteSCB",SPIOWRITE_SCB_ADDR, 141862306a36Sopenharmony_ci magic_snoop_scb, 141962306a36Sopenharmony_ci SCB_ON_PARENT_NEXT_SCB)) 142062306a36Sopenharmony_ci goto _fail_end; 142162306a36Sopenharmony_ci 142262306a36Sopenharmony_ci /* SPDIF input sampel rate converter */ 142362306a36Sopenharmony_ci src_task_scb = cs46xx_dsp_create_src_task_scb(chip,"SrcTaskSCB_SPDIFI", 142462306a36Sopenharmony_ci ins->spdif_in_sample_rate, 142562306a36Sopenharmony_ci SRC_OUTPUT_BUF1, 142662306a36Sopenharmony_ci SRC_DELAY_BUF1,SRCTASK_SCB_ADDR, 142762306a36Sopenharmony_ci master_mix_scb, 142862306a36Sopenharmony_ci SCB_ON_PARENT_SUBLIST_SCB,1); 142962306a36Sopenharmony_ci 143062306a36Sopenharmony_ci if (!src_task_scb) goto _fail_end; 143162306a36Sopenharmony_ci cs46xx_src_unlink(chip,src_task_scb); 143262306a36Sopenharmony_ci 143362306a36Sopenharmony_ci /* NOTE: when we now how to detect the SPDIF input 143462306a36Sopenharmony_ci sample rate we will use this SRC to adjust it */ 143562306a36Sopenharmony_ci ins->spdif_in_src = src_task_scb; 143662306a36Sopenharmony_ci 143762306a36Sopenharmony_ci cs46xx_dsp_async_init(chip,timing_master_scb); 143862306a36Sopenharmony_ci return 0; 143962306a36Sopenharmony_ci 144062306a36Sopenharmony_ci _fail_end: 144162306a36Sopenharmony_ci dev_err(chip->card->dev, "dsp_spos: failed to setup SCB's in DSP\n"); 144262306a36Sopenharmony_ci return -EINVAL; 144362306a36Sopenharmony_ci} 144462306a36Sopenharmony_ci 144562306a36Sopenharmony_cistatic int cs46xx_dsp_async_init (struct snd_cs46xx *chip, 144662306a36Sopenharmony_ci struct dsp_scb_descriptor * fg_entry) 144762306a36Sopenharmony_ci{ 144862306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 144962306a36Sopenharmony_ci struct dsp_symbol_entry * s16_async_codec_input_task; 145062306a36Sopenharmony_ci struct dsp_symbol_entry * spdifo_task; 145162306a36Sopenharmony_ci struct dsp_symbol_entry * spdifi_task; 145262306a36Sopenharmony_ci struct dsp_scb_descriptor * spdifi_scb_desc, * spdifo_scb_desc, * async_codec_scb_desc; 145362306a36Sopenharmony_ci 145462306a36Sopenharmony_ci s16_async_codec_input_task = cs46xx_dsp_lookup_symbol(chip, "S16_ASYNCCODECINPUTTASK", SYMBOL_CODE); 145562306a36Sopenharmony_ci if (s16_async_codec_input_task == NULL) { 145662306a36Sopenharmony_ci dev_err(chip->card->dev, 145762306a36Sopenharmony_ci "dsp_spos: symbol S16_ASYNCCODECINPUTTASK not found\n"); 145862306a36Sopenharmony_ci return -EIO; 145962306a36Sopenharmony_ci } 146062306a36Sopenharmony_ci spdifo_task = cs46xx_dsp_lookup_symbol(chip, "SPDIFOTASK", SYMBOL_CODE); 146162306a36Sopenharmony_ci if (spdifo_task == NULL) { 146262306a36Sopenharmony_ci dev_err(chip->card->dev, 146362306a36Sopenharmony_ci "dsp_spos: symbol SPDIFOTASK not found\n"); 146462306a36Sopenharmony_ci return -EIO; 146562306a36Sopenharmony_ci } 146662306a36Sopenharmony_ci 146762306a36Sopenharmony_ci spdifi_task = cs46xx_dsp_lookup_symbol(chip, "SPDIFITASK", SYMBOL_CODE); 146862306a36Sopenharmony_ci if (spdifi_task == NULL) { 146962306a36Sopenharmony_ci dev_err(chip->card->dev, 147062306a36Sopenharmony_ci "dsp_spos: symbol SPDIFITASK not found\n"); 147162306a36Sopenharmony_ci return -EIO; 147262306a36Sopenharmony_ci } 147362306a36Sopenharmony_ci 147462306a36Sopenharmony_ci { 147562306a36Sopenharmony_ci /* 0xBC0 */ 147662306a36Sopenharmony_ci struct dsp_spdifoscb spdifo_scb = { 147762306a36Sopenharmony_ci /* 0 */ DSP_SPOS_UUUU, 147862306a36Sopenharmony_ci { 147962306a36Sopenharmony_ci /* 1 */ 0xb0, 148062306a36Sopenharmony_ci /* 2 */ 0, 148162306a36Sopenharmony_ci /* 3 */ 0, 148262306a36Sopenharmony_ci /* 4 */ 0, 148362306a36Sopenharmony_ci }, 148462306a36Sopenharmony_ci /* NOTE: the SPDIF output task read samples in mono 148562306a36Sopenharmony_ci format, the AsynchFGTxSCB task writes to buffer 148662306a36Sopenharmony_ci in stereo format 148762306a36Sopenharmony_ci */ 148862306a36Sopenharmony_ci /* 5 */ RSCONFIG_SAMPLE_16MONO + RSCONFIG_MODULO_256, 148962306a36Sopenharmony_ci /* 6 */ ( SPDIFO_IP_OUTPUT_BUFFER1 << 0x10 ) | 0xFFFC, 149062306a36Sopenharmony_ci /* 7 */ 0,0, 149162306a36Sopenharmony_ci /* 8 */ 0, 149262306a36Sopenharmony_ci /* 9 */ FG_TASK_HEADER_ADDR, NULL_SCB_ADDR, 149362306a36Sopenharmony_ci /* A */ spdifo_task->address, 149462306a36Sopenharmony_ci SPDIFO_SCB_INST + SPDIFOFIFOPointer, 149562306a36Sopenharmony_ci { 149662306a36Sopenharmony_ci /* B */ 0x0040, /*DSP_SPOS_UUUU,*/ 149762306a36Sopenharmony_ci /* C */ 0x20ff, /*DSP_SPOS_UUUU,*/ 149862306a36Sopenharmony_ci }, 149962306a36Sopenharmony_ci /* D */ 0x804c,0, /* SPDIFOFIFOPointer:SPDIFOStatRegAddr; */ 150062306a36Sopenharmony_ci /* E */ 0x0108,0x0001, /* SPDIFOStMoFormat:SPDIFOFIFOBaseAddr; */ 150162306a36Sopenharmony_ci /* F */ DSP_SPOS_UUUU /* SPDIFOFree; */ 150262306a36Sopenharmony_ci }; 150362306a36Sopenharmony_ci 150462306a36Sopenharmony_ci /* 0xBB0 */ 150562306a36Sopenharmony_ci struct dsp_spdifiscb spdifi_scb = { 150662306a36Sopenharmony_ci /* 0 */ DSP_SPOS_UULO,DSP_SPOS_UUHI, 150762306a36Sopenharmony_ci /* 1 */ 0, 150862306a36Sopenharmony_ci /* 2 */ 0, 150962306a36Sopenharmony_ci /* 3 */ 1,4000, /* SPDIFICountLimit SPDIFICount */ 151062306a36Sopenharmony_ci /* 4 */ DSP_SPOS_UUUU, /* SPDIFIStatusData */ 151162306a36Sopenharmony_ci /* 5 */ 0,DSP_SPOS_UUHI, /* StatusData, Free4 */ 151262306a36Sopenharmony_ci /* 6 */ DSP_SPOS_UUUU, /* Free3 */ 151362306a36Sopenharmony_ci /* 7 */ DSP_SPOS_UU,DSP_SPOS_DC, /* Free2 BitCount*/ 151462306a36Sopenharmony_ci /* 8 */ DSP_SPOS_UUUU, /* TempStatus */ 151562306a36Sopenharmony_ci /* 9 */ SPDIFO_SCB_INST, NULL_SCB_ADDR, 151662306a36Sopenharmony_ci /* A */ spdifi_task->address, 151762306a36Sopenharmony_ci SPDIFI_SCB_INST + SPDIFIFIFOPointer, 151862306a36Sopenharmony_ci /* NOTE: The SPDIF input task write the sample in mono 151962306a36Sopenharmony_ci format from the HW FIFO, the AsynchFGRxSCB task reads 152062306a36Sopenharmony_ci them in stereo 152162306a36Sopenharmony_ci */ 152262306a36Sopenharmony_ci /* B */ RSCONFIG_SAMPLE_16MONO + RSCONFIG_MODULO_128, 152362306a36Sopenharmony_ci /* C */ (SPDIFI_IP_OUTPUT_BUFFER1 << 0x10) | 0xFFFC, 152462306a36Sopenharmony_ci /* D */ 0x8048,0, 152562306a36Sopenharmony_ci /* E */ 0x01f0,0x0001, 152662306a36Sopenharmony_ci /* F */ DSP_SPOS_UUUU /* SPDIN_STATUS monitor */ 152762306a36Sopenharmony_ci }; 152862306a36Sopenharmony_ci 152962306a36Sopenharmony_ci /* 0xBA0 */ 153062306a36Sopenharmony_ci struct dsp_async_codec_input_scb async_codec_input_scb = { 153162306a36Sopenharmony_ci /* 0 */ DSP_SPOS_UUUU, 153262306a36Sopenharmony_ci /* 1 */ 0, 153362306a36Sopenharmony_ci /* 2 */ 0, 153462306a36Sopenharmony_ci /* 3 */ 1,4000, 153562306a36Sopenharmony_ci /* 4 */ 0x0118,0x0001, 153662306a36Sopenharmony_ci /* 5 */ RSCONFIG_SAMPLE_16MONO + RSCONFIG_MODULO_64, 153762306a36Sopenharmony_ci /* 6 */ (ASYNC_IP_OUTPUT_BUFFER1 << 0x10) | 0xFFFC, 153862306a36Sopenharmony_ci /* 7 */ DSP_SPOS_UU,0x3, 153962306a36Sopenharmony_ci /* 8 */ DSP_SPOS_UUUU, 154062306a36Sopenharmony_ci /* 9 */ SPDIFI_SCB_INST,NULL_SCB_ADDR, 154162306a36Sopenharmony_ci /* A */ s16_async_codec_input_task->address, 154262306a36Sopenharmony_ci HFG_TREE_SCB + AsyncCIOFIFOPointer, 154362306a36Sopenharmony_ci 154462306a36Sopenharmony_ci /* B */ RSCONFIG_SAMPLE_16STEREO + RSCONFIG_MODULO_64, 154562306a36Sopenharmony_ci /* C */ (ASYNC_IP_OUTPUT_BUFFER1 << 0x10), /*(ASYNC_IP_OUTPUT_BUFFER1 << 0x10) | 0xFFFC,*/ 154662306a36Sopenharmony_ci 154762306a36Sopenharmony_ci#ifdef UseASER1Input 154862306a36Sopenharmony_ci /* short AsyncCIFIFOPointer:AsyncCIStatRegAddr; 154962306a36Sopenharmony_ci Init. 0000:8042: for ASER1 155062306a36Sopenharmony_ci 0000:8044: for ASER2 */ 155162306a36Sopenharmony_ci /* D */ 0x8042,0, 155262306a36Sopenharmony_ci 155362306a36Sopenharmony_ci /* short AsyncCIStMoFormat:AsyncCIFIFOBaseAddr; 155462306a36Sopenharmony_ci Init 1 stero:8050 ASER1 155562306a36Sopenharmony_ci Init 0 mono:8070 ASER2 155662306a36Sopenharmony_ci Init 1 Stereo : 0100 ASER1 (Set by script) */ 155762306a36Sopenharmony_ci /* E */ 0x0100,0x0001, 155862306a36Sopenharmony_ci 155962306a36Sopenharmony_ci#endif 156062306a36Sopenharmony_ci 156162306a36Sopenharmony_ci#ifdef UseASER2Input 156262306a36Sopenharmony_ci /* short AsyncCIFIFOPointer:AsyncCIStatRegAddr; 156362306a36Sopenharmony_ci Init. 0000:8042: for ASER1 156462306a36Sopenharmony_ci 0000:8044: for ASER2 */ 156562306a36Sopenharmony_ci /* D */ 0x8044,0, 156662306a36Sopenharmony_ci 156762306a36Sopenharmony_ci /* short AsyncCIStMoFormat:AsyncCIFIFOBaseAddr; 156862306a36Sopenharmony_ci Init 1 stero:8050 ASER1 156962306a36Sopenharmony_ci Init 0 mono:8070 ASER2 157062306a36Sopenharmony_ci Init 1 Stereo : 0100 ASER1 (Set by script) */ 157162306a36Sopenharmony_ci /* E */ 0x0110,0x0001, 157262306a36Sopenharmony_ci 157362306a36Sopenharmony_ci#endif 157462306a36Sopenharmony_ci 157562306a36Sopenharmony_ci /* short AsyncCIOutputBufModulo:AsyncCIFree; 157662306a36Sopenharmony_ci AsyncCIOutputBufModulo: The modulo size for 157762306a36Sopenharmony_ci the output buffer of this task */ 157862306a36Sopenharmony_ci /* F */ 0, /* DSP_SPOS_UUUU */ 157962306a36Sopenharmony_ci }; 158062306a36Sopenharmony_ci 158162306a36Sopenharmony_ci spdifo_scb_desc = cs46xx_dsp_create_scb(chip,"SPDIFOSCB",(u32 *)&spdifo_scb,SPDIFO_SCB_INST); 158262306a36Sopenharmony_ci 158362306a36Sopenharmony_ci if (snd_BUG_ON(!spdifo_scb_desc)) 158462306a36Sopenharmony_ci return -EIO; 158562306a36Sopenharmony_ci spdifi_scb_desc = cs46xx_dsp_create_scb(chip,"SPDIFISCB",(u32 *)&spdifi_scb,SPDIFI_SCB_INST); 158662306a36Sopenharmony_ci if (snd_BUG_ON(!spdifi_scb_desc)) 158762306a36Sopenharmony_ci return -EIO; 158862306a36Sopenharmony_ci async_codec_scb_desc = cs46xx_dsp_create_scb(chip,"AsynCodecInputSCB",(u32 *)&async_codec_input_scb, HFG_TREE_SCB); 158962306a36Sopenharmony_ci if (snd_BUG_ON(!async_codec_scb_desc)) 159062306a36Sopenharmony_ci return -EIO; 159162306a36Sopenharmony_ci 159262306a36Sopenharmony_ci async_codec_scb_desc->parent_scb_ptr = NULL; 159362306a36Sopenharmony_ci async_codec_scb_desc->next_scb_ptr = spdifi_scb_desc; 159462306a36Sopenharmony_ci async_codec_scb_desc->sub_list_ptr = ins->the_null_scb; 159562306a36Sopenharmony_ci async_codec_scb_desc->task_entry = s16_async_codec_input_task; 159662306a36Sopenharmony_ci 159762306a36Sopenharmony_ci spdifi_scb_desc->parent_scb_ptr = async_codec_scb_desc; 159862306a36Sopenharmony_ci spdifi_scb_desc->next_scb_ptr = spdifo_scb_desc; 159962306a36Sopenharmony_ci spdifi_scb_desc->sub_list_ptr = ins->the_null_scb; 160062306a36Sopenharmony_ci spdifi_scb_desc->task_entry = spdifi_task; 160162306a36Sopenharmony_ci 160262306a36Sopenharmony_ci spdifo_scb_desc->parent_scb_ptr = spdifi_scb_desc; 160362306a36Sopenharmony_ci spdifo_scb_desc->next_scb_ptr = fg_entry; 160462306a36Sopenharmony_ci spdifo_scb_desc->sub_list_ptr = ins->the_null_scb; 160562306a36Sopenharmony_ci spdifo_scb_desc->task_entry = spdifo_task; 160662306a36Sopenharmony_ci 160762306a36Sopenharmony_ci /* this one is faked, as the parnet of SPDIFO task 160862306a36Sopenharmony_ci is the FG task tree */ 160962306a36Sopenharmony_ci fg_entry->parent_scb_ptr = spdifo_scb_desc; 161062306a36Sopenharmony_ci 161162306a36Sopenharmony_ci /* for proc fs */ 161262306a36Sopenharmony_ci cs46xx_dsp_proc_register_scb_desc (chip,spdifo_scb_desc); 161362306a36Sopenharmony_ci cs46xx_dsp_proc_register_scb_desc (chip,spdifi_scb_desc); 161462306a36Sopenharmony_ci cs46xx_dsp_proc_register_scb_desc (chip,async_codec_scb_desc); 161562306a36Sopenharmony_ci 161662306a36Sopenharmony_ci /* Async MASTER ENABLE, affects both SPDIF input and output */ 161762306a36Sopenharmony_ci snd_cs46xx_pokeBA0(chip, BA0_ASER_MASTER, 0x1 ); 161862306a36Sopenharmony_ci } 161962306a36Sopenharmony_ci 162062306a36Sopenharmony_ci return 0; 162162306a36Sopenharmony_ci} 162262306a36Sopenharmony_ci 162362306a36Sopenharmony_cistatic void cs46xx_dsp_disable_spdif_hw (struct snd_cs46xx *chip) 162462306a36Sopenharmony_ci{ 162562306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 162662306a36Sopenharmony_ci 162762306a36Sopenharmony_ci /* set SPDIF output FIFO slot */ 162862306a36Sopenharmony_ci snd_cs46xx_pokeBA0(chip, BA0_ASER_FADDR, 0); 162962306a36Sopenharmony_ci 163062306a36Sopenharmony_ci /* SPDIF output MASTER ENABLE */ 163162306a36Sopenharmony_ci cs46xx_poke_via_dsp (chip,SP_SPDOUT_CONTROL, 0); 163262306a36Sopenharmony_ci 163362306a36Sopenharmony_ci /* right and left validate bit */ 163462306a36Sopenharmony_ci /*cs46xx_poke_via_dsp (chip,SP_SPDOUT_CSUV, ins->spdif_csuv_default);*/ 163562306a36Sopenharmony_ci cs46xx_poke_via_dsp (chip,SP_SPDOUT_CSUV, 0x0); 163662306a36Sopenharmony_ci 163762306a36Sopenharmony_ci /* clear fifo pointer */ 163862306a36Sopenharmony_ci cs46xx_poke_via_dsp (chip,SP_SPDIN_FIFOPTR, 0x0); 163962306a36Sopenharmony_ci 164062306a36Sopenharmony_ci /* monitor state */ 164162306a36Sopenharmony_ci ins->spdif_status_out &= ~DSP_SPDIF_STATUS_HW_ENABLED; 164262306a36Sopenharmony_ci} 164362306a36Sopenharmony_ci 164462306a36Sopenharmony_ciint cs46xx_dsp_enable_spdif_hw (struct snd_cs46xx *chip) 164562306a36Sopenharmony_ci{ 164662306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 164762306a36Sopenharmony_ci 164862306a36Sopenharmony_ci /* if hw-ctrl already enabled, turn off to reset logic ... */ 164962306a36Sopenharmony_ci cs46xx_dsp_disable_spdif_hw (chip); 165062306a36Sopenharmony_ci udelay(50); 165162306a36Sopenharmony_ci 165262306a36Sopenharmony_ci /* set SPDIF output FIFO slot */ 165362306a36Sopenharmony_ci snd_cs46xx_pokeBA0(chip, BA0_ASER_FADDR, ( 0x8000 | ((SP_SPDOUT_FIFO >> 4) << 4) )); 165462306a36Sopenharmony_ci 165562306a36Sopenharmony_ci /* SPDIF output MASTER ENABLE */ 165662306a36Sopenharmony_ci cs46xx_poke_via_dsp (chip,SP_SPDOUT_CONTROL, 0x80000000); 165762306a36Sopenharmony_ci 165862306a36Sopenharmony_ci /* right and left validate bit */ 165962306a36Sopenharmony_ci cs46xx_poke_via_dsp (chip,SP_SPDOUT_CSUV, ins->spdif_csuv_default); 166062306a36Sopenharmony_ci 166162306a36Sopenharmony_ci /* monitor state */ 166262306a36Sopenharmony_ci ins->spdif_status_out |= DSP_SPDIF_STATUS_HW_ENABLED; 166362306a36Sopenharmony_ci 166462306a36Sopenharmony_ci return 0; 166562306a36Sopenharmony_ci} 166662306a36Sopenharmony_ci 166762306a36Sopenharmony_ciint cs46xx_dsp_enable_spdif_in (struct snd_cs46xx *chip) 166862306a36Sopenharmony_ci{ 166962306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 167062306a36Sopenharmony_ci 167162306a36Sopenharmony_ci /* turn on amplifier */ 167262306a36Sopenharmony_ci chip->active_ctrl(chip, 1); 167362306a36Sopenharmony_ci chip->amplifier_ctrl(chip, 1); 167462306a36Sopenharmony_ci 167562306a36Sopenharmony_ci if (snd_BUG_ON(ins->asynch_rx_scb)) 167662306a36Sopenharmony_ci return -EINVAL; 167762306a36Sopenharmony_ci if (snd_BUG_ON(!ins->spdif_in_src)) 167862306a36Sopenharmony_ci return -EINVAL; 167962306a36Sopenharmony_ci 168062306a36Sopenharmony_ci mutex_lock(&chip->spos_mutex); 168162306a36Sopenharmony_ci 168262306a36Sopenharmony_ci if ( ! (ins->spdif_status_out & DSP_SPDIF_STATUS_INPUT_CTRL_ENABLED) ) { 168362306a36Sopenharmony_ci /* time countdown enable */ 168462306a36Sopenharmony_ci cs46xx_poke_via_dsp (chip,SP_ASER_COUNTDOWN, 0x80000005); 168562306a36Sopenharmony_ci /* NOTE: 80000005 value is just magic. With all values 168662306a36Sopenharmony_ci that I've tested this one seem to give the best result. 168762306a36Sopenharmony_ci Got no explication why. (Benny) */ 168862306a36Sopenharmony_ci 168962306a36Sopenharmony_ci /* SPDIF input MASTER ENABLE */ 169062306a36Sopenharmony_ci cs46xx_poke_via_dsp (chip,SP_SPDIN_CONTROL, 0x800003ff); 169162306a36Sopenharmony_ci 169262306a36Sopenharmony_ci ins->spdif_status_out |= DSP_SPDIF_STATUS_INPUT_CTRL_ENABLED; 169362306a36Sopenharmony_ci } 169462306a36Sopenharmony_ci 169562306a36Sopenharmony_ci /* create and start the asynchronous receiver SCB */ 169662306a36Sopenharmony_ci ins->asynch_rx_scb = cs46xx_dsp_create_asynch_fg_rx_scb(chip,"AsynchFGRxSCB", 169762306a36Sopenharmony_ci ASYNCRX_SCB_ADDR, 169862306a36Sopenharmony_ci SPDIFI_SCB_INST, 169962306a36Sopenharmony_ci SPDIFI_IP_OUTPUT_BUFFER1, 170062306a36Sopenharmony_ci ins->spdif_in_src, 170162306a36Sopenharmony_ci SCB_ON_PARENT_SUBLIST_SCB); 170262306a36Sopenharmony_ci 170362306a36Sopenharmony_ci spin_lock_irq(&chip->reg_lock); 170462306a36Sopenharmony_ci 170562306a36Sopenharmony_ci /* reset SPDIF input sample buffer pointer */ 170662306a36Sopenharmony_ci /*snd_cs46xx_poke (chip, (SPDIFI_SCB_INST + 0x0c) << 2, 170762306a36Sopenharmony_ci (SPDIFI_IP_OUTPUT_BUFFER1 << 0x10) | 0xFFFC);*/ 170862306a36Sopenharmony_ci 170962306a36Sopenharmony_ci /* reset FIFO ptr */ 171062306a36Sopenharmony_ci /*cs46xx_poke_via_dsp (chip,SP_SPDIN_FIFOPTR, 0x0);*/ 171162306a36Sopenharmony_ci cs46xx_src_link(chip,ins->spdif_in_src); 171262306a36Sopenharmony_ci 171362306a36Sopenharmony_ci /* unmute SRC volume */ 171462306a36Sopenharmony_ci cs46xx_dsp_scb_set_volume (chip,ins->spdif_in_src,0x7fff,0x7fff); 171562306a36Sopenharmony_ci 171662306a36Sopenharmony_ci spin_unlock_irq(&chip->reg_lock); 171762306a36Sopenharmony_ci 171862306a36Sopenharmony_ci /* set SPDIF input sample rate and unmute 171962306a36Sopenharmony_ci NOTE: only 48khz support for SPDIF input this time */ 172062306a36Sopenharmony_ci /* cs46xx_dsp_set_src_sample_rate(chip,ins->spdif_in_src,48000); */ 172162306a36Sopenharmony_ci 172262306a36Sopenharmony_ci /* monitor state */ 172362306a36Sopenharmony_ci ins->spdif_status_in = 1; 172462306a36Sopenharmony_ci mutex_unlock(&chip->spos_mutex); 172562306a36Sopenharmony_ci 172662306a36Sopenharmony_ci return 0; 172762306a36Sopenharmony_ci} 172862306a36Sopenharmony_ci 172962306a36Sopenharmony_ciint cs46xx_dsp_disable_spdif_in (struct snd_cs46xx *chip) 173062306a36Sopenharmony_ci{ 173162306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 173262306a36Sopenharmony_ci 173362306a36Sopenharmony_ci if (snd_BUG_ON(!ins->asynch_rx_scb)) 173462306a36Sopenharmony_ci return -EINVAL; 173562306a36Sopenharmony_ci if (snd_BUG_ON(!ins->spdif_in_src)) 173662306a36Sopenharmony_ci return -EINVAL; 173762306a36Sopenharmony_ci 173862306a36Sopenharmony_ci mutex_lock(&chip->spos_mutex); 173962306a36Sopenharmony_ci 174062306a36Sopenharmony_ci /* Remove the asynchronous receiver SCB */ 174162306a36Sopenharmony_ci cs46xx_dsp_remove_scb (chip,ins->asynch_rx_scb); 174262306a36Sopenharmony_ci ins->asynch_rx_scb = NULL; 174362306a36Sopenharmony_ci 174462306a36Sopenharmony_ci cs46xx_src_unlink(chip,ins->spdif_in_src); 174562306a36Sopenharmony_ci 174662306a36Sopenharmony_ci /* monitor state */ 174762306a36Sopenharmony_ci ins->spdif_status_in = 0; 174862306a36Sopenharmony_ci mutex_unlock(&chip->spos_mutex); 174962306a36Sopenharmony_ci 175062306a36Sopenharmony_ci /* restore amplifier */ 175162306a36Sopenharmony_ci chip->active_ctrl(chip, -1); 175262306a36Sopenharmony_ci chip->amplifier_ctrl(chip, -1); 175362306a36Sopenharmony_ci 175462306a36Sopenharmony_ci return 0; 175562306a36Sopenharmony_ci} 175662306a36Sopenharmony_ci 175762306a36Sopenharmony_ciint cs46xx_dsp_enable_pcm_capture (struct snd_cs46xx *chip) 175862306a36Sopenharmony_ci{ 175962306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 176062306a36Sopenharmony_ci 176162306a36Sopenharmony_ci if (snd_BUG_ON(ins->pcm_input)) 176262306a36Sopenharmony_ci return -EINVAL; 176362306a36Sopenharmony_ci if (snd_BUG_ON(!ins->ref_snoop_scb)) 176462306a36Sopenharmony_ci return -EINVAL; 176562306a36Sopenharmony_ci 176662306a36Sopenharmony_ci mutex_lock(&chip->spos_mutex); 176762306a36Sopenharmony_ci ins->pcm_input = cs46xx_add_record_source(chip,ins->ref_snoop_scb,PCMSERIALIN_PCM_SCB_ADDR, 176862306a36Sopenharmony_ci "PCMSerialInput_Wave"); 176962306a36Sopenharmony_ci mutex_unlock(&chip->spos_mutex); 177062306a36Sopenharmony_ci 177162306a36Sopenharmony_ci return 0; 177262306a36Sopenharmony_ci} 177362306a36Sopenharmony_ci 177462306a36Sopenharmony_ciint cs46xx_dsp_disable_pcm_capture (struct snd_cs46xx *chip) 177562306a36Sopenharmony_ci{ 177662306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 177762306a36Sopenharmony_ci 177862306a36Sopenharmony_ci if (snd_BUG_ON(!ins->pcm_input)) 177962306a36Sopenharmony_ci return -EINVAL; 178062306a36Sopenharmony_ci 178162306a36Sopenharmony_ci mutex_lock(&chip->spos_mutex); 178262306a36Sopenharmony_ci cs46xx_dsp_remove_scb (chip,ins->pcm_input); 178362306a36Sopenharmony_ci ins->pcm_input = NULL; 178462306a36Sopenharmony_ci mutex_unlock(&chip->spos_mutex); 178562306a36Sopenharmony_ci 178662306a36Sopenharmony_ci return 0; 178762306a36Sopenharmony_ci} 178862306a36Sopenharmony_ci 178962306a36Sopenharmony_ciint cs46xx_dsp_enable_adc_capture (struct snd_cs46xx *chip) 179062306a36Sopenharmony_ci{ 179162306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 179262306a36Sopenharmony_ci 179362306a36Sopenharmony_ci if (snd_BUG_ON(ins->adc_input)) 179462306a36Sopenharmony_ci return -EINVAL; 179562306a36Sopenharmony_ci if (snd_BUG_ON(!ins->codec_in_scb)) 179662306a36Sopenharmony_ci return -EINVAL; 179762306a36Sopenharmony_ci 179862306a36Sopenharmony_ci mutex_lock(&chip->spos_mutex); 179962306a36Sopenharmony_ci ins->adc_input = cs46xx_add_record_source(chip,ins->codec_in_scb,PCMSERIALIN_SCB_ADDR, 180062306a36Sopenharmony_ci "PCMSerialInput_ADC"); 180162306a36Sopenharmony_ci mutex_unlock(&chip->spos_mutex); 180262306a36Sopenharmony_ci 180362306a36Sopenharmony_ci return 0; 180462306a36Sopenharmony_ci} 180562306a36Sopenharmony_ci 180662306a36Sopenharmony_ciint cs46xx_dsp_disable_adc_capture (struct snd_cs46xx *chip) 180762306a36Sopenharmony_ci{ 180862306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 180962306a36Sopenharmony_ci 181062306a36Sopenharmony_ci if (snd_BUG_ON(!ins->adc_input)) 181162306a36Sopenharmony_ci return -EINVAL; 181262306a36Sopenharmony_ci 181362306a36Sopenharmony_ci mutex_lock(&chip->spos_mutex); 181462306a36Sopenharmony_ci cs46xx_dsp_remove_scb (chip,ins->adc_input); 181562306a36Sopenharmony_ci ins->adc_input = NULL; 181662306a36Sopenharmony_ci mutex_unlock(&chip->spos_mutex); 181762306a36Sopenharmony_ci 181862306a36Sopenharmony_ci return 0; 181962306a36Sopenharmony_ci} 182062306a36Sopenharmony_ci 182162306a36Sopenharmony_ciint cs46xx_poke_via_dsp (struct snd_cs46xx *chip, u32 address, u32 data) 182262306a36Sopenharmony_ci{ 182362306a36Sopenharmony_ci u32 temp; 182462306a36Sopenharmony_ci int i; 182562306a36Sopenharmony_ci 182662306a36Sopenharmony_ci /* santiy check the parameters. (These numbers are not 100% correct. They are 182762306a36Sopenharmony_ci a rough guess from looking at the controller spec.) */ 182862306a36Sopenharmony_ci if (address < 0x8000 || address >= 0x9000) 182962306a36Sopenharmony_ci return -EINVAL; 183062306a36Sopenharmony_ci 183162306a36Sopenharmony_ci /* initialize the SP_IO_WRITE SCB with the data. */ 183262306a36Sopenharmony_ci temp = ( address << 16 ) | ( address & 0x0000FFFF); /* offset 0 <-- address2 : address1 */ 183362306a36Sopenharmony_ci 183462306a36Sopenharmony_ci snd_cs46xx_poke(chip,( SPIOWRITE_SCB_ADDR << 2), temp); 183562306a36Sopenharmony_ci snd_cs46xx_poke(chip,((SPIOWRITE_SCB_ADDR + 1) << 2), data); /* offset 1 <-- data1 */ 183662306a36Sopenharmony_ci snd_cs46xx_poke(chip,((SPIOWRITE_SCB_ADDR + 2) << 2), data); /* offset 1 <-- data2 */ 183762306a36Sopenharmony_ci 183862306a36Sopenharmony_ci /* Poke this location to tell the task to start */ 183962306a36Sopenharmony_ci snd_cs46xx_poke(chip,((SPIOWRITE_SCB_ADDR + 6) << 2), SPIOWRITE_SCB_ADDR << 0x10); 184062306a36Sopenharmony_ci 184162306a36Sopenharmony_ci /* Verify that the task ran */ 184262306a36Sopenharmony_ci for (i=0; i<25; i++) { 184362306a36Sopenharmony_ci udelay(125); 184462306a36Sopenharmony_ci 184562306a36Sopenharmony_ci temp = snd_cs46xx_peek(chip,((SPIOWRITE_SCB_ADDR + 6) << 2)); 184662306a36Sopenharmony_ci if (temp == 0x00000000) 184762306a36Sopenharmony_ci break; 184862306a36Sopenharmony_ci } 184962306a36Sopenharmony_ci 185062306a36Sopenharmony_ci if (i == 25) { 185162306a36Sopenharmony_ci dev_err(chip->card->dev, 185262306a36Sopenharmony_ci "dsp_spos: SPIOWriteTask not responding\n"); 185362306a36Sopenharmony_ci return -EBUSY; 185462306a36Sopenharmony_ci } 185562306a36Sopenharmony_ci 185662306a36Sopenharmony_ci return 0; 185762306a36Sopenharmony_ci} 185862306a36Sopenharmony_ci 185962306a36Sopenharmony_ciint cs46xx_dsp_set_dac_volume (struct snd_cs46xx * chip, u16 left, u16 right) 186062306a36Sopenharmony_ci{ 186162306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 186262306a36Sopenharmony_ci struct dsp_scb_descriptor * scb; 186362306a36Sopenharmony_ci 186462306a36Sopenharmony_ci mutex_lock(&chip->spos_mutex); 186562306a36Sopenharmony_ci 186662306a36Sopenharmony_ci /* main output */ 186762306a36Sopenharmony_ci scb = ins->master_mix_scb->sub_list_ptr; 186862306a36Sopenharmony_ci while (scb != ins->the_null_scb) { 186962306a36Sopenharmony_ci cs46xx_dsp_scb_set_volume (chip,scb,left,right); 187062306a36Sopenharmony_ci scb = scb->next_scb_ptr; 187162306a36Sopenharmony_ci } 187262306a36Sopenharmony_ci 187362306a36Sopenharmony_ci /* rear output */ 187462306a36Sopenharmony_ci scb = ins->rear_mix_scb->sub_list_ptr; 187562306a36Sopenharmony_ci while (scb != ins->the_null_scb) { 187662306a36Sopenharmony_ci cs46xx_dsp_scb_set_volume (chip,scb,left,right); 187762306a36Sopenharmony_ci scb = scb->next_scb_ptr; 187862306a36Sopenharmony_ci } 187962306a36Sopenharmony_ci 188062306a36Sopenharmony_ci ins->dac_volume_left = left; 188162306a36Sopenharmony_ci ins->dac_volume_right = right; 188262306a36Sopenharmony_ci 188362306a36Sopenharmony_ci mutex_unlock(&chip->spos_mutex); 188462306a36Sopenharmony_ci 188562306a36Sopenharmony_ci return 0; 188662306a36Sopenharmony_ci} 188762306a36Sopenharmony_ci 188862306a36Sopenharmony_ciint cs46xx_dsp_set_iec958_volume (struct snd_cs46xx * chip, u16 left, u16 right) 188962306a36Sopenharmony_ci{ 189062306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 189162306a36Sopenharmony_ci 189262306a36Sopenharmony_ci mutex_lock(&chip->spos_mutex); 189362306a36Sopenharmony_ci 189462306a36Sopenharmony_ci if (ins->asynch_rx_scb != NULL) 189562306a36Sopenharmony_ci cs46xx_dsp_scb_set_volume (chip,ins->asynch_rx_scb, 189662306a36Sopenharmony_ci left,right); 189762306a36Sopenharmony_ci 189862306a36Sopenharmony_ci ins->spdif_input_volume_left = left; 189962306a36Sopenharmony_ci ins->spdif_input_volume_right = right; 190062306a36Sopenharmony_ci 190162306a36Sopenharmony_ci mutex_unlock(&chip->spos_mutex); 190262306a36Sopenharmony_ci 190362306a36Sopenharmony_ci return 0; 190462306a36Sopenharmony_ci} 190562306a36Sopenharmony_ci 190662306a36Sopenharmony_ci#ifdef CONFIG_PM_SLEEP 190762306a36Sopenharmony_ciint cs46xx_dsp_resume(struct snd_cs46xx * chip) 190862306a36Sopenharmony_ci{ 190962306a36Sopenharmony_ci struct dsp_spos_instance * ins = chip->dsp_spos_instance; 191062306a36Sopenharmony_ci int i, err; 191162306a36Sopenharmony_ci 191262306a36Sopenharmony_ci /* clear parameter, sample and code areas */ 191362306a36Sopenharmony_ci snd_cs46xx_clear_BA1(chip, DSP_PARAMETER_BYTE_OFFSET, 191462306a36Sopenharmony_ci DSP_PARAMETER_BYTE_SIZE); 191562306a36Sopenharmony_ci snd_cs46xx_clear_BA1(chip, DSP_SAMPLE_BYTE_OFFSET, 191662306a36Sopenharmony_ci DSP_SAMPLE_BYTE_SIZE); 191762306a36Sopenharmony_ci snd_cs46xx_clear_BA1(chip, DSP_CODE_BYTE_OFFSET, DSP_CODE_BYTE_SIZE); 191862306a36Sopenharmony_ci 191962306a36Sopenharmony_ci for (i = 0; i < ins->nmodules; i++) { 192062306a36Sopenharmony_ci struct dsp_module_desc *module = &ins->modules[i]; 192162306a36Sopenharmony_ci struct dsp_segment_desc *seg; 192262306a36Sopenharmony_ci u32 doffset, dsize; 192362306a36Sopenharmony_ci 192462306a36Sopenharmony_ci seg = get_segment_desc(module, SEGTYPE_SP_PARAMETER); 192562306a36Sopenharmony_ci err = dsp_load_parameter(chip, seg); 192662306a36Sopenharmony_ci if (err < 0) 192762306a36Sopenharmony_ci return err; 192862306a36Sopenharmony_ci 192962306a36Sopenharmony_ci seg = get_segment_desc(module, SEGTYPE_SP_SAMPLE); 193062306a36Sopenharmony_ci err = dsp_load_sample(chip, seg); 193162306a36Sopenharmony_ci if (err < 0) 193262306a36Sopenharmony_ci return err; 193362306a36Sopenharmony_ci 193462306a36Sopenharmony_ci seg = get_segment_desc(module, SEGTYPE_SP_PROGRAM); 193562306a36Sopenharmony_ci if (!seg) 193662306a36Sopenharmony_ci continue; 193762306a36Sopenharmony_ci 193862306a36Sopenharmony_ci doffset = seg->offset * 4 + module->load_address * 4 193962306a36Sopenharmony_ci + DSP_CODE_BYTE_OFFSET; 194062306a36Sopenharmony_ci dsize = seg->size * 4; 194162306a36Sopenharmony_ci err = snd_cs46xx_download(chip, 194262306a36Sopenharmony_ci ins->code.data + module->load_address, 194362306a36Sopenharmony_ci doffset, dsize); 194462306a36Sopenharmony_ci if (err < 0) 194562306a36Sopenharmony_ci return err; 194662306a36Sopenharmony_ci } 194762306a36Sopenharmony_ci 194862306a36Sopenharmony_ci for (i = 0; i < ins->ntask; i++) { 194962306a36Sopenharmony_ci struct dsp_task_descriptor *t = &ins->tasks[i]; 195062306a36Sopenharmony_ci _dsp_create_task_tree(chip, t->data, t->address, t->size); 195162306a36Sopenharmony_ci } 195262306a36Sopenharmony_ci 195362306a36Sopenharmony_ci for (i = 0; i < ins->nscb; i++) { 195462306a36Sopenharmony_ci struct dsp_scb_descriptor *s = &ins->scbs[i]; 195562306a36Sopenharmony_ci if (s->deleted) 195662306a36Sopenharmony_ci continue; 195762306a36Sopenharmony_ci _dsp_create_scb(chip, s->data, s->address); 195862306a36Sopenharmony_ci } 195962306a36Sopenharmony_ci for (i = 0; i < ins->nscb; i++) { 196062306a36Sopenharmony_ci struct dsp_scb_descriptor *s = &ins->scbs[i]; 196162306a36Sopenharmony_ci if (s->deleted) 196262306a36Sopenharmony_ci continue; 196362306a36Sopenharmony_ci if (s->updated) 196462306a36Sopenharmony_ci cs46xx_dsp_spos_update_scb(chip, s); 196562306a36Sopenharmony_ci if (s->volume_set) 196662306a36Sopenharmony_ci cs46xx_dsp_scb_set_volume(chip, s, 196762306a36Sopenharmony_ci s->volume[0], s->volume[1]); 196862306a36Sopenharmony_ci } 196962306a36Sopenharmony_ci if (ins->spdif_status_out & DSP_SPDIF_STATUS_HW_ENABLED) { 197062306a36Sopenharmony_ci cs46xx_dsp_enable_spdif_hw(chip); 197162306a36Sopenharmony_ci snd_cs46xx_poke(chip, (ins->ref_snoop_scb->address + 2) << 2, 197262306a36Sopenharmony_ci (OUTPUT_SNOOP_BUFFER + 0x10) << 0x10); 197362306a36Sopenharmony_ci if (ins->spdif_status_out & DSP_SPDIF_STATUS_PLAYBACK_OPEN) 197462306a36Sopenharmony_ci cs46xx_poke_via_dsp(chip, SP_SPDOUT_CSUV, 197562306a36Sopenharmony_ci ins->spdif_csuv_stream); 197662306a36Sopenharmony_ci } 197762306a36Sopenharmony_ci if (chip->dsp_spos_instance->spdif_status_in) { 197862306a36Sopenharmony_ci cs46xx_poke_via_dsp(chip, SP_ASER_COUNTDOWN, 0x80000005); 197962306a36Sopenharmony_ci cs46xx_poke_via_dsp(chip, SP_SPDIN_CONTROL, 0x800003ff); 198062306a36Sopenharmony_ci } 198162306a36Sopenharmony_ci return 0; 198262306a36Sopenharmony_ci} 198362306a36Sopenharmony_ci#endif 1984