PASDK-514: Moved CB status to Non-cached memory.
[processor-sdk/performance-audio-sr.git] / pasdk / test_dsp / framework / audioStreamInpProc.c
2 /*
3 Copyright (c) 2017, Texas Instruments Incorporated - http://www.ti.com/
4 All rights reserved.
6 * Redistribution and use in source and binary forms, with or without 
7 * modification, are permitted provided that the following conditions
8 * are met:
9 *
10 * Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 *
13 * Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the
16 * distribution.
17 *
18 * Neither the name of Texas Instruments Incorporated nor the names of
19 * its contributors may be used to endorse or promote products derived
20 * from this software without specific prior written permission.
21 *
22 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
23 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
24 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
25 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
26 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
27 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
28 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
29 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
30 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
31 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
32 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33 *
34 */
36 /*
37  *  ======== audioStreamInpProc.c ========
38  */
40 #include <xdc/std.h>
41 #include <xdc/cfg/global.h>
42 #include <xdc/runtime/Diags.h>
43 #include <xdc/runtime/Error.h>
44 #include <xdc/runtime/Log.h>
45 #include <xdc/runtime/Memory.h>
46 #include <xdc/runtime/System.h>
47 #include <ti/sysbios/BIOS.h>
48 #include <ti/sysbios/hal/Hwi.h>
49 #include <ti/sysbios/hal/Cache.h>
50 #include <ti/sysbios/knl/Clock.h>
51 #include <ti/sysbios/knl/Task.h>
52 #include <ti/ipc/Ipc.h>
53 #include <ti/ipc/MessageQ.h>
54 #include <ti/ipc/MultiProc.h>
56 #include <sio.h>
57 #include <pafsio_ialg.h>
59 #include "ioConfig.h"
61 #include "common.h"
62 #include "paf_heapMgr.h"
63 #include "aspMsg_common.h"
64 #include "aspMsg_master.h"
65 #include "aspDecOpCircBuf_master.h"
66 #include "aspOutInitSync_master.h"
67 #include "audioStreamProc_common.h"
68 #include "audioStreamProc_master.h"
69 #include "audioStreamInpProc.h"
70 #include "statusOp_common.h"
72 #include "pfp/pfp.h"
73 #include "pfp_app.h"        /* contains all PFP ID's */
74 Int32 gNumPfpAsit1=0; // debug
75 Int32 gNumPfpAsit2=0;
77 // debug
78 //#include "dbgCapAf.h"
81 // -----------------------------------------------------------------------------
82 // Debugging Trace Control, local to this file.
83 // 
84 #include "logp.h"
86 #define TRACE_ARC(a)
88 // allows you to set a different trace module in pa.cfg
89 #define TR_MOD  trace
91 // Allow a developer to selectively enable tracing.
92 #define CURRENT_TRACE_MASK      0x27
94 #define TRACE_MASK_TERSE        0x01   // only flag errors and show init
95 #define TRACE_MASK_GENERAL      0x02   // half dozen lines per frame
96 #define TRACE_MASK_VERBOSE      0x04   // trace full operation
97 #define TRACE_MASK_DATA         0x08   // Show data
98 #define TRACE_MASK_TIME         0x10   // Timing related traces
99 #define TRACE_MASK_MSG          0x20   // Message related traces
101 #if !(CURRENT_TRACE_MASK & TRACE_MASK_TERSE)
102     #undef  TRACE_TERSE0
103     #undef  TRACE_TERSE1
104     #undef  TRACE_TERSE2
105     #undef  TRACE_TERSE3
106     #undef  TRACE_TERSE4
107     #define TRACE_TERSE0(a)
108     #define TRACE_TERSE1(a,b)
109     #define TRACE_TERSE2(a,b,c)
110     #define TRACE_TERSE3(a,b,c,d)
111     #define TRACE_TERSE4(a,b,c,d,e)
112 #endif
114 #if !(CURRENT_TRACE_MASK & TRACE_MASK_GENERAL)
115     #undef  TRACE_GEN0
116     #undef  TRACE_GEN1
117     #undef  TRACE_GEN2
118     #undef  TRACE_GEN3
119     #undef  TRACE_GEN4
120     #define TRACE_GEN0(a)
121     #define TRACE_GEN1(a,b)
122     #define TRACE_GEN2(a,b,c)
123     #define TRACE_GEN3(a,b,c,d)
124     #define TRACE_GEN4(a,b,c,d,e)
125 #endif
127 #if (CURRENT_TRACE_MASK & TRACE_MASK_VERBOSE)
128     // consolidate list of processing strings, indexed by PAF_SOURCE
129     static char *procName[] =
130     {
131         "", //PAF_SOURCE_UNKNOWN
132         "", //PAF_SOURCE_NONE
133         "AS%d: Pass processing ...",   //PAF_SOURCE_PASS
134         "AS%d: SNG processing ...",    //PAF_SOURCE_SNG
135         "AS%d: Auto processing ...",   //PAF_SOURCE_AUTO
136         "AS%d: Auto processing ...",   //PAF_SOURCE_BITSTREAM
137         "AS%d: DTS processing ...",    //PAF_SOURCE_DTSALL
138         "AS%d: PCM processing ...",    //PAF_SOURCE_PCMAUTO
139         "AS%d: PCM processing ...",    //PAF_SOURCE_PCM
140         "AS%d: PCN processing ...",    //PAF_SOURCE_PC8
141         "AS%d: AC3 processing ...",    //PAF_SOURCE_AC3
142         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS
143         "AS%d: AAC processing ...",    //PAF_SOURCE_AAC
144         "AS%d: MPG processing ...",    //PAF_SOURCE_MPEG
145         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS12
146         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS13
147         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS14
148         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS16
149         "AS%d: WMP processing ...",    //PAF_SOURCE_WMA9PRO
150         "AS%d: MP3 processing ...",    //PAF_SOURCE_MP3
151         "AS%d: DSD processing ...",    //PAF_SOURCE_DSD1
152         "AS%d: DSD processing ...",    //PAF_SOURCE_DSD2
153         "AS%d: DSD processing ...",    //PAF_SOURCE_DSD3
154         "AS%d: DDP processing ...",    //PAF_SOURCE_DDP
155         "AS%d: DTSHD processing ...",  //PAF_SOURCE_DTSHD
156         "AS%d: THD processing ...",    //PAF_SOURCE_THD
157         "AS%d: DXP processing ...",    //PAF_SOURCE_DXP
158         "AS%d: WMA processing ...",    //PAF_SOURCE_WMA
159     };
161 #else
162     #undef  TRACE_VERBOSE0
163     #undef  TRACE_VERBOSE1
164     #undef  TRACE_VERBOSE2
165     #undef  TRACE_VERBOSE3
166     #undef  TRACE_VERBOSE4
167     #define TRACE_VERBOSE0(a)
168     #define TRACE_VERBOSE1(a,b)
169     #define TRACE_VERBOSE2(a,b,c)
170     #define TRACE_VERBOSE3(a,b,c,d)
171     #define TRACE_VERBOSE4(a,b,c,d,e)
172 #endif
174 #if (CURRENT_TRACE_MASK & TRACE_MASK_DATA)
175     #define TRACE_DATA(a) LOG_printf a
176 #else
177     #define TRACE_DATA(a)
178 #endif
180 #if (CURRENT_TRACE_MASK & TRACE_MASK_TIME)
181     #define TRACE_TIME(a) LOG_printf a
182     #define TIME_MOD  trace // this could be different
183     static Int dtime()
184     {
185          static Int old_time = 0;
186          Int time = TSK_time();
187          Int delta_time = time - old_time;
188          old_time = time;
189          return( delta_time);
190     }
192     static char *stateName[11] =
193     {
194          "INIT",
195          "INFO1",
196          "AGAIN",
197          "INFO2",
198          "CONT",
199          "TIME",
200          "DECODE",
201          "STREAM",
202          "ENCODE",
203          "FINAL",
204          "QUIT"
205     };
207 #else
208     #define TRACE_TIME(a)
209 #endif
211 #if !(CURRENT_TRACE_MASK & TRACE_MASK_MSG)
212     #undef  TRACE_MSG0
213     #undef  TRACE_MSG1
214     #undef  TRACE_MSG2
215     #undef  TRACE_MSG3
216     #undef  TRACE_MSG4
217     #define TRACE_MSG0(a)
218     #define TRACE_MSG1(a,b)
219     #define TRACE_MSG2(a,b,c)
220     #define TRACE_MSG3(a,b,c,d)
221     #define TRACE_MSG4(a,b,c,d,e)
222 #endif
223     
225 // .............................................................................
227 #include <pafsio.h>
228 #include "paferr.h"
230 #include <acp_mds.h>
232 #include <pcm.h>
234 #include <pce.h>
236 #include <doberr.h>
238 #include <diberr.h>
240 #include <stdasp.h>
242 #include "as0.h"
243 #include "asperr.h"
245 #include "audioStreamProc_params.h"
246 #include "audioStreamProc_patchs.h"
247 #include "audioStreamProc_config.h"
248 #include "audioStreamInpProc.h"
251 #include "dbgBenchmark.h" // PCM high-sampling rate + SRC + CAR benchmarking
252 #ifdef _ENABLE_BENCHMARK_PCMHSR_SRC_CAR_
253 //
254 // Performing PCM high-sampling rate + SRC + CAR benchmarking
255 //
257 #define PROFILER
258 #endif
260 #ifdef PROFILER
261 extern UInt32 start_profiling;
262 #endif
264 extern UInt32 gAspProfileEnable;
266 //
267 // Audio Stream Definitions
268 //
270 // minimum audio frame "length" in samples (must be multiple of PA_MODULO)
271 #define MINFRAMELENGTH 24
272 #define PA_MODULO       8   // also defined independently in ARC2 code, and may be hard coded other places.
275 //
276 // Decoder Definitions
277 //
278 //#define decLinkInit pQ->i_decLinkInit
280 //
281 // Audio Stream Processing Definitions
282 //
283 //#define aspLinkInit pQ->i_aspLinkInit
285 //
286 // Encoder Definitions
287 //
288 #define encLinkInit pQ->i_encLinkInit
290 //
291 // Input, Output Definitions
292 //
293 #define inpLinkInit pP->i_inpLinkInit
294 //#define outLinkInit pP->i_outLinkInit
296 /* ---------------------------------------------------------------- */
297 /*              Parameter macro definitions end here.               */
298 /* ---------------------------------------------------------------- */
300 //
301 // Standardized Definitions
302 //
304 //#define DEC_Handle PCM_Handle /* works for all: SNG, PCM, AC3, DTS, AAC */
306 #define __TASK_NAME__  "TaskAsip"
309 //
310 // Audio Stream Input Task definitions
311 //
313 #define ASIP_FRAMELEN_SS_DEFAULT    ( 256 )
314 #define ASIP_FRAMELEN_SS_PCM        ( FRAMELENGTH ) // pP->frameLength
315 #define ASIP_FRAMELEN_SS_DDP_AC3    ( 1536 )        // hard-coded
316 #define ASIP_FRAMELEN_SS_THD        ( 1536 )        // hard-coded
317 #define ASIP_FRAMELEN_SS_DTS        ( 512 )         
319 // Compute decoder frame length based on selected source
320 Int getFrameLengthSourceSel(
321     const PAF_ASIT_Params *pP, 
322     Int8 sourceSelect
323 );
325 LINNO_DEFN(TaskAsip); /* Line number macros */
326 ERRNO_DEFN(TaskAsip); /* Error number macros */
328 // ASIT ASP messaging
329 AspMsgMaster_Module gAsitAspMsgMaster;  // ASIT message master
331 // ASIT configuration
332 #pragma DATA_SECTION(gPAF_ASIT_config, ".globalSectionPafAsitConfig")
333 PAF_ASIT_Config gPAF_ASIT_config = {
334     NULL,               // taskHandle
335     NULL,               // acp
336     &gAsitAspMsgMaster, // hAspMsgMaster
337     &gPAF_ASPM_config,  // pAspmCfg, shared ASIT/ASOT configuration
338     &gPAF_AST_config,   // pAstCfg, shared ASIT/ASOT/ASDT configuration
339     NULL,               // pIoInp, ASIT IO configuration
340     0                   // inpDec, ASIT state
341 };
343 // For writeDECCommandRestart
344 volatile UInt32 gCommandOutputTask_SYNC   =0;
345 volatile UInt32 gCommandOutputTask_ACK    =0;
347 // Global debug counters */
348 UInt32 gAsipRxSioReclaimCnt     =0;
349 UInt32 gAsipInitCnt             =0;
350 UInt32 gAsipInfo1Cnt            =0;
351 UInt32 gAsipInfo2Cnt            =0;
352 UInt32 gAsipDecodeCnt           =0;
353 UInt32 gAsipDecodeErrCnt        =0;
354 UInt32 gAsipFinalCnt            =0;
355 UInt32 gAsipQuitCnt             =0;
356 UInt32 gAsipInfo1_PrimaryErrCnt =0;
357 UInt32 gAsipInfo1_ErrCnt        =0;
358 UInt32 gAsipInfo2_PrimaryErrCnt =0;
359 UInt32 gAsipInfo2_ErrCnt        =0;
360 // debug
361 UInt32 gCapIbReset_cnt          =0;
362 UInt32 gCapIb_cnt               =0;
363 UInt32 gCbWrtAfErrCnt           =0; // decoder output circular buffer write error count (returned from ARM to DSP)
364                                    
365 #include "dbgDib.h" // debug
367 extern struct {
368     Int size;
369     IALG_Status *pStatus[512];
370 } IACP_STD_BETA_TABLE;
372 // debug
373 //#include "evmc66x_gpio_dbg.h"
375 /*
376  *  ======== taskAsipFxnInit ========
377  *  Audio Stream Input Processing initialization function
378  */
379 Void taskAsipFxnInit(
380     const PAF_ASIT_Params *pP,
381     const PAF_ASIT_Patchs *pQ
384     PAF_ASIT_Config *pAsitCfg;          // ASIT configuration pointer
385     PAF_AST_Config *pAstCfg;            // AST Common (shared) configuration pointer
386     PAF_AST_IoInp *pInp;            /* Input I/O components */
387     AspMsgMaster_Handle hAspMsgMaster;  // ASIT message master handle    
388     Int as;                             // Audio Stream Number (1, 2, etc.)
389     Int z;                              // input/encode/stream/decode/output counter
390     Int i;                              // phase
391     Int zMI, zMS, zX;
392     Int size;
393     Int status;
395     Log_info0("Enter taskAsipFxnInit()");
397     //
398     // Audio Stream Input Task Parameters & Patch (*pP, *pQ)
399     //
400     if (!pP)
401     {
402         TRACE_TERSE0("TaskAsip: No Parameters defined. Exiting.");
403         LINNO_RPRT(TaskAsip, -1);
404         return;
405     }
407     if (!pQ)
408     {
409         TRACE_TERSE0("TaskAsip: No Patchs defined. Exiting.");
410         LINNO_RPRT(TaskAsip, -1);
411         return;
412     }
414     //
415     // Audio Stream Input Task Configuration (*pAsitCfg):
416     //
417     pAsitCfg = &gPAF_ASIT_config;               // initialize pointer to task configuration
418     pAsitCfg->taskHandle = Task_self();         // set task handle
419     pAstCfg = pAsitCfg->pAstCfg;                // get pointer to AST common (shared) configuration
420     hAspMsgMaster = pAsitCfg->hAspMsgMaster;    // get message master handle
422     /* Set Audio Stream Number (1, 2, etc.) */
423     as = gBetaPrimeValue + 1;
424     pAstCfg->as = as;
425     TRACE_TERSE1("TaskAsip: Started with AS%d.", as);
427     //
428     // Initialize message log trace and line number reporting
429     //
430     for (z=STREAM1; z < STREAMN; z++)
431     {
432         TRACE_TERSE1("TaskAsip: AS%d: initiated", as+z);
433     }
434     LINNO_RPRT(TaskAsip, -1);
436     //
437     // Determine decoder and stream indices associated with the master input
438     //
439     zMI = pP->zone.master;
440     pAstCfg->masterDec = zMI;
441     pAstCfg->masterStr = zMI;
442     for (zX = DECODE1; zX < DECODEN; zX++)
443     {
444         if (pP->inputsFromDecodes[zX] == zMI)
445         {
446             pAstCfg->masterDec = zX;
447             pAstCfg->masterStr = pP->streamsFromDecodes[zX];
448             break;
449         }
450     }
451     zMS = pAstCfg->masterStr;
453     // Initialize as per parametrized phases:
454     //
455     //   In standard form these are:
456     //      - Malloc: Memory Allocation
457     //      - Config: Configuration Initialization
458     //      - AcpAlg: ACP Algorithm Initialization and Local Attachment
459     //      - Common: Common Memory Initialization
460     //      - AlgKey: Dec/Enc chain to Array Initialization
461     //      - Device: I/O Device Initialization
462     //      - DecOpCircBuf: Decoder Output Circular Buffer
463     //      - OutIS: Output Init-Sync
464     //
465     LINNO_RPRT(TaskAsip, -2);
466     for (i=0; i < lengthof(pP->fxns->initPhase); i++)
467     {
468         Int linno;
469         if (pP->fxns->initPhase[i])
470         {
471             linno = pP->fxns->initPhase[i](pP, pQ, pAsitCfg);
472             if (linno)
473             {
474                 LINNO_RPRT(TaskAsip, linno);
475                 return;
476             }
477         }
478         else
479         {
480             TRACE_TERSE1("TaskAsip: AS%d: initialization phase - null", as+zMS);
481         }
482         TRACE_TERSE2("TaskAsip: AS%d: initialization phase - %d completed", as+zMS, i);
483         LINNO_RPRT(TaskAsip, -i-3);
484     }
486     //
487     // End of Initialization -- display memory usage report.
488     //
489     if (pP->fxns->memStatusPrint)
490     {
491         pP->fxns->memStatusPrint("ASIT MEMSTAT REPORT",
492             HEAP_INTERNAL, HEAP_INTERNAL1, HEAP_EXTERNAL,
493             HEAP_INTERNAL1_SHM, HEAP_EXTERNAL_SHM, HEAP_EXTERNAL_NONCACHED_SHM);
494     }
496     // write back AST shared configuration
497     Cache_wb(pAstCfg, sizeof(PAF_AST_Config), Cache_Type_ALLD, 0);
498     Cache_wait();
500     // write back Dec configuration
501     Cache_wb(&pAstCfg->xDec[0], DECODEN*sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
502     Cache_wait();
504     // write back entire beta table
505     Cache_wb((Ptr)(&IACP_STD_BETA_TABLE.pStatus[0]), 512*sizeof(IALG_Status *), Cache_Type_ALLD, 0);
506     Cache_wait();
508     // send start initialization message to slave
509     status = AspMsgSnd(hAspMsgMaster, ASP_SLAVE_START, NULL);
510     if (status != ASP_MSG_NO_ERR)
511     {
512         SW_BREAKPOINT;
513     }
514     
515     // wait for initialization complete message from slave
516     // no other thread is allowed to run until Slave finishes startup
517     do {
518         status = AspMsgRcvAck(hAspMsgMaster, ASP_MASTER_START_DONE, NULL, FALSE);
519     } while (status == ASP_MSG_ERR_QUEUE_TIMEOUT);
520     if (status != ASP_MSG_NO_ERR)
521     {
522         SW_BREAKPOINT;
523     }
525     // invalidate Status structure addresses for Beta Units initialized on Slave
526     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
527     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
528     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
529     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
530     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
531     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
532     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
533     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DTSUHDA]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
534     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
535     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC2]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
536     Cache_wait();
537     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]) Log_info0("WARNING: beta unit for Dec==NULL");
538     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]) Log_info0("WARNING: beta unit for Dec==NULL");
539     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]) Log_info0("WARNING: beta unit for Dec==NULL");
540     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]) Log_info0("WARNING: beta unit for Dec==NULL");
541     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]) Log_info0("WARNING: beta unit for Dec==NULL");
542     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]) Log_info0("WARNING: beta unit for Dec==NULL");
543     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]) Log_info0("WARNING: beta unit for Dec==NULL");
544     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DTSUHDA]) Log_info0("WARNING: beta unit for Dec==NULL");
545     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC]) Log_info0("WARNING: beta unit for Dec==NULL");
546     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC2]) Log_info0("WARNING: beta unit for Dec==NULL");
548     // invalidate Status structures for Beta Units initialized on Slave
549     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE] != NULL)
550     {
551         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), sizeof(Int), Cache_Type_ALLD, 0);
552         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]->size;
553         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), size, Cache_Type_ALLD, 0);
554         Cache_wait();
555     }
556     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM] != NULL)
557     {
558         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), sizeof(Int), Cache_Type_ALLD, 0);
559         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]->size;
560         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), size, Cache_Type_ALLD, 0);
561         Cache_wait();
562     }
563     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2] != NULL)
564     {
565         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]), sizeof(Int), Cache_Type_ALLD, 0);
566         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]->size;
567         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]), size, Cache_Type_ALLD, 0);
568         Cache_wait();
569     }
570     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP] != NULL)
571     {
572         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), sizeof(Int), Cache_Type_ALLD, 0);
573         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]->size;
574         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), size, Cache_Type_ALLD, 0);
575         Cache_wait();
576     }
577     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2] != NULL)
578     {
579         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]), sizeof(Int), Cache_Type_ALLD, 0);
580         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]->size;
581         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]), size, Cache_Type_ALLD, 0);
582         Cache_wait();
583     }
584     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD] != NULL)
585     {
586         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]), sizeof(Int), Cache_Type_ALLD, 0);
587         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]->size;
588         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]), size, Cache_Type_ALLD, 0);
589         Cache_wait();
590     }
591     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2] != NULL)
592     {
593         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]), sizeof(Int), Cache_Type_ALLD, 0);
594         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]->size;
595         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]), size, Cache_Type_ALLD, 0);
596         Cache_wait();
597     }
598     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_DTSUHDA] != NULL)
599     {
600         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DTSUHDA]), sizeof(Int), Cache_Type_ALLD, 0);
601         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DTSUHDA]->size;
602         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DTSUHDA]), size, Cache_Type_ALLD, 0);
603         Cache_wait();
604     }
605     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC] != NULL)
606     {
607         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC]), sizeof(Int), Cache_Type_ALLD, 0);
608         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC]->size;
609         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC]), size, Cache_Type_ALLD, 0);
610         Cache_wait();
611     }
612     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC2] != NULL)
613     {
614         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC2]), sizeof(Int), Cache_Type_ALLD, 0);
615         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC2]->size;
616         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC2]), size, Cache_Type_ALLD, 0);
617         Cache_wait();
618     }
620 #ifdef NON_CACHE_STATUS
621     // Get the shared status structure GateMP handles. Initialized at slave.
622     if (statusOp_Init(GATEMP_INDEX_DEC) == STATUSOP_INIT_FAIL)
623     {
624         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_DEC);
625     }
626     if (statusOp_Init(GATEMP_INDEX_DDP) == STATUSOP_INIT_FAIL)
627     {
628         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_DDP);
629     }
630     if (statusOp_Init(GATEMP_INDEX_PCM) == STATUSOP_INIT_FAIL)
631     {
632         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_PCM);
633     }
634     if (statusOp_Init(GATEMP_INDEX_THD) == STATUSOP_INIT_FAIL)
635     {
636         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_THD);
637     }
638     if (statusOp_Init(GATEMP_INDEX_DTS) == STATUSOP_INIT_FAIL)
639     {
640         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_DTS);
641     }
642 #endif
644     // invalidate Dec configuration
645     Cache_inv(&gPAF_AST_config.xDec[0], DECODEN*sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
646     Cache_wait();
648     pInp = &pAsitCfg->pIoInp[zMI];        // pointer to input I/O components
649     pInp->asipState = ASIT_RESET;
650     pInp->firstTimeInit = TRUE;
651     pInp->numAsitRestart = 0;
652     pInp->hMcaspChan = NULL;
654 } /* taskAsipFxnInit */
656 /*
657  *  ======== taskAsipFxn ========
658  *  Audio Stream Input Processing task function
659  */
660 #ifdef PASDK_SIO_DEV
661 Void taskAsipFxn(
662 #else
663 Void taskAsipFxn_Not_Used(
664 #endif
665     const PAF_ASIT_Params *pP,
666     const PAF_ASIT_Patchs *pQ
669     PAF_ASIT_Config *pAsitCfg;          // ASIT configuration pointer
670     PAF_AST_Config *pAstCfg;            // AST Common (shared) configuration pointer
671     AspMsgMaster_Handle hAspMsgMaster;  // ASIT message master handle
672     Int as;                             // Audio Stream Number (1, 2, etc.)
673     Int z;                              // input/encode/stream/decode/output counter
674     Int errno;                          // error number
675     Int zMD, zMI, zMS;
676     Int loopCount = 0;  // used to stop trace to see startup behavior.        
677     // Messaging
678     Int8 tempVar8;
679     char asipMsgBuf[ASP_MSG_BUF_LEN];
680     Int status;
682     Log_info0("Enter taskAsipFxn()");
684     taskAsipFxnInit(pP, pQ);  // initialization of input task
685     
686     //
687     // Audio Stream Input Task Configuration (*pAsitCfg):
688     //
689     pAsitCfg = &gPAF_ASIT_config;       // initialize pointer to task configuration
690     pAstCfg = pAsitCfg->pAstCfg;        // get pointer to AST common (shared) configuration
691     hAspMsgMaster = pAsitCfg->hAspMsgMaster; // get message master handle
693     /* Set Audio Stream Number (1, 2, etc.) */
694     as = pAstCfg->as;
696     //
697     // Determine decoder and stream indices associated with the master input
698     //
699     zMI = pP->zone.master;
700     zMD = pAstCfg->masterDec;
701     zMS = pAstCfg->masterStr;
702     
703     //
704     // Main processing loop
705     //   
706     for (z=STREAM1; z < STREAMN; z++)
707     {
708         TRACE_VERBOSE1("TaskAsip: AS%d: running", as+z);
709     }
711     TRACE_TERSE0("TaskAsip: Entering Main Loop.");
712     
713     errno = 0;
714     for (;;)
715     {
716         Int sourceSelect;
717         XDAS_Int8 sourceProgram;
719         loopCount++;
721 #if 0   // enable and tune to see startup behavior.
722         // this is an alternative to fixed/circular setting in pa.cfg.
723         // If you are searching for a memory allocation failure, disable on first round.
724         // All allocation has already happened.
725         // This is the outer loop.  This loop count goes up when the stream resets.
726         // If the stream is running without problems, this does not increment.
727         // If the stream is repeatedly resetting, this loop count will go up rapidly.
728         if (loopCount > 10)  // see traces for a few of the passes through the main loop.
729         {
730              TRACE_TERSE1("TaskAsip: Trace stopped at loop %d.", loopCount);
731              LOG_disable(&TR_MOD);  // stop tracing
732         }
733 #endif
735         TRACE_GEN2("TaskAsip (begin Main loop %d) (errno 0x%x)", loopCount, errno);
736         TRACE_TIME((&TIME_MOD, "as1_f2... + %d = %d (begin Main loop)", dtime(), TSK_time()));
737         
738         // since not decoding indicate such
739         pP->fxns->sourceDecode(pP, pQ, pAsitCfg, PAF_SOURCE_NONE);
741         // any error forces idling of input
742         if (errno) 
743         {
744             // If gCommandOutputTask_SYNC invoked by writeDECCommandRestart, wait for output task in sync ...
745             if (gCommandOutputTask_SYNC) {
746                 TRACE_VERBOSE1("TaskAsip: writeDECCommandRestart issued ... Wait for ack from output task side (errno=%d)", errno);
747                 // Wait for ack
748                 while (gCommandOutputTask_ACK == 0) {
749                     Task_sleep(1);
750                 }
751                 TRACE_VERBOSE0("TaskAsip: writeDECCommandRestart issued ... Sync-ed! Startover the process");
752                 gCommandOutputTask_ACK = 0;
753                 gCommandOutputTask_SYNC = 0;
754             }
755             
756             for (z=INPUT1; z < INPUTN; z++)
757             {
758                 if (pAstCfg->xInp[z].hRxSio)
759                 {
760                     SIO_idle(pAstCfg->xInp[z].hRxSio);
761                 }
762             }
763         
764             TRACE_TERSE1("TaskAsip: Trace stopped at loop %d.", loopCount);
765             ERRNO_RPRT(TaskAsip, errno);
766         }
767         
768         // Execute a TSK_sleep to ensure that any non-blocking code paths are broken
769         // up to allow lower priority tasks to run. This may seem odd to be at the top
770         // of the state machine but provides for a cleaner flow even though the very
771         // first time we enter we do a sleep which is non-intuitive.
772         TRACE_VERBOSE1("TaskAsip: AS%d: ... sleeping ...", as+zMS);
773         TRACE_TIME((&TIME_MOD, "as1-f2... + %d = %d (begin SLEEP)", dtime(), TSK_time()));
774         Task_sleep(1);
776         TRACE_GEN1("TaskAsip: AS%d: Input device selection ...", as+zMS);
777         errno = pP->fxns->selectDevices(pP, pQ, pAsitCfg);
778         if (errno)
779         {
780             TRACE_TERSE2("TaskAsip: selectDevices returned errno = 0x%04x at line %d. AS%d", errno, as+zMS);
781             continue;
782         }
784         // if no master input selected then we don't know what may be at the input
785         // so set to unknown and skip any remaining processing
786         if (!pAstCfg->xInp[zMI].hRxSio)
787         {
788             sharedMemWriteInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram), 
789                                (Int8)PAF_SOURCE_UNKNOWN, GATEMP_INDEX_DEC);
791             TRACE_VERBOSE1("TaskAsip: AS%d: No input selected...", as+zMS);
792             continue;
793         }
794         
795         // if here then we have a valid input so query its status
796         errno = pP->fxns->updateInputStatus(pAstCfg->xInp[zMI].hRxSio, &pAstCfg->xInp[zMI].inpBufStatus, &pAstCfg->xInp[zMI].inpBufConfig);
797         if (errno)
798         {
799             TRACE_VERBOSE1("TaskAsip: continue as updateInputStatus returns 0x%x", errno);
800             continue;
801         }
803         // If master decoder is not enabled, or the input is unlocked, then do nothing
804         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.mode), 
805                                      GATEMP_INDEX_DEC);
806         if (!tempVar8 || !pAstCfg->xInp[zMI].inpBufStatus.lock)
807         {
808             TRACE_VERBOSE0("TaskAsip: Not locked, continue");
809             continue;
810         }
811         
812         // If no source selected then do nothing
813         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceSelect), 
814                                      GATEMP_INDEX_DEC);
815         if (tempVar8 == PAF_SOURCE_NONE)
816         {
817             sharedMemWriteInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram), 
818                                (Int8)PAF_SOURCE_NONE, GATEMP_INDEX_DEC);
819             TRACE_VERBOSE1("TaskAsip: AS%d: no source selected, continue", as+zMS);
820             continue;
821         }
823         // If we want pass processing then proceed directly
824         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceSelect), 
825                                      GATEMP_INDEX_DEC);
826         if (tempVar8 == PAF_SOURCE_PASS)
827         {
828             TRACE_VERBOSE1("TaskAsip: AS%d: Pass processing ...", as+zMS);
829             sharedMemWriteInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram), 
830                                (Int8)PAF_SOURCE_PASS, GATEMP_INDEX_DEC);
832             pP->fxns->sourceDecode(pP, pQ, pAsitCfg, PAF_SOURCE_PASS);
833             if (pP->fxns->passProcessing)
834             {
835                 errno = pP->fxns->passProcessing(pP, pQ, pAsitCfg, NULL);                
836             }
837             else 
838             {
839                 TRACE_TERSE2("TaskAsip: AS%d: Pass Processing not supported, errno 0x%x", as+zMS, ASPERR_PASS);
840                 errno = ASPERR_PASS;
841             }
842             TRACE_VERBOSE0("TaskAsip: continue");
843             continue;
844         }
846         // .....................................................................
847         // At this point we have an enabled input and want to decode something.
848         // If no decoder selected then do nothing. Need to reset the sourceProgram, since
849         // when no decoder is selected there are no calls to IB
850         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceSelect), 
851                                      GATEMP_INDEX_DEC);
852         pfpBegin(PFP_ID_ASIT_1, pAsitCfg->taskHandle);  // PFP begin
853         gNumPfpAsit1++;
854         errno = pP->fxns->autoProcessing(pP, pQ, pAsitCfg, tempVar8, NULL);
855         pfpEnd(PFP_ID_ASIT_1, PFP_FINISH_MEAS);         // PFP end
856         gNumPfpAsit1--;
858         if (errno)
859         {
860             TRACE_VERBOSE1("TaskAsip: autoProcessing returns 0x%x, continue", errno);
861             continue;
862         }
863         
864         // query for input type
865         errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_SOURCEPROGRAM, (Arg )&sourceProgram);
866         if (errno)
867         {
868             TRACE_TERSE2("TaskAsip: SIO_ctrl returns 0x%x, then 0x%x, continue", errno, ASPERR_AUTO_PROGRAM);
869             errno = ASPERR_AUTO_PROGRAM;
870             continue;
871         }
873         sharedMemWriteInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram), 
874                            sourceProgram, GATEMP_INDEX_DEC);
876         // if input is unclassifiable then do nothing
877         if (sourceProgram == PAF_SOURCE_UNKNOWN)
878         {
879             TRACE_VERBOSE0("TaskAsip: Source program unknown. continue");
880             continue;
881         }
883         // now that we have some input classification, and possibly an outstanding
884         // input frame, we determine whether or not to call decodeProcessing and with
885         // what decAlg.
886         sourceSelect = PAF_SOURCE_NONE;
887         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceSelect), 
888                                      GATEMP_INDEX_DEC);
889         switch (tempVar8)
890         {
891             // If autodetecting, decoding everything, and input is something
892             // (i.e. bitstream or PCM) then decode.
893             case PAF_SOURCE_AUTO:
894                 if (sourceProgram >= PAF_SOURCE_PCM)
895                 {
896                     sourceSelect = sourceProgram;                    
897                 }
898                 break;
900             // If autodetecting, decoding only PCM, and input is PCM then decode.
901             case PAF_SOURCE_PCMAUTO:
902                 if (sourceProgram == PAF_SOURCE_PCM)
903                 {
904                     sourceSelect = sourceProgram;                    
905                 }
906                 break;
908             // If autodetecting, decoding only bitstreams, and input is a bitstream then decode.
909             case PAF_SOURCE_BITSTREAM:
910                 if (sourceProgram >= PAF_SOURCE_AC3)
911                 {
912                     sourceSelect = sourceProgram;                    
913                 }
914                 break;
916             // If autodetecting, decoding only DTS, and input is DTS then decode.
917             case PAF_SOURCE_DTSALL:
918                 switch (sourceProgram) 
919                 {
920                     case PAF_SOURCE_DTS11:
921                     case PAF_SOURCE_DTS12:
922                     case PAF_SOURCE_DTS13:
923                     case PAF_SOURCE_DTS14:
924                     case PAF_SOURCE_DTS16:
925                     case PAF_SOURCE_DTSHD:
926                         sourceSelect = sourceProgram;
927                         break;
928                 }
929                 break;
931             // All others, e.g., force modes, fall through to here.
932             // If user made specific selection then program must match select.
933             // (NB: this compare relies on ordering of PAF_SOURCE)
934             default:
935                 sourceSelect = (Int)sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
936                                                               GATEMP_INDEX_DEC);
937                 if ((sourceSelect >= PAF_SOURCE_PCM) && (sourceSelect <= PAF_SOURCE_N))
938                 {
939                     if (sourceProgram != sourceSelect)
940                     {
941                         sourceSelect = PAF_SOURCE_NONE;                        
942                     }
943                 }
944                 break;
945         }
947         // if we didn't find any matches then skip
948         if (sourceSelect == PAF_SOURCE_NONE)
949         {
950             TRACE_VERBOSE0("TaskAsip: no matching source type, continue");
951             continue;
952         }
954 #if 0 // debug
955         // reset IB capture buffer
956         capIbReset();
957         gCapIbReset_cnt++;
958         Log_info0("capIbReset()");
959 #endif
961         // send source select message to slave
962         *(Int32 *)&asipMsgBuf[0] = sourceSelect;
963         status = AspMsgSnd(hAspMsgMaster, ASP_SLAVE_DEC_SOURCE_SELECT, asipMsgBuf);
964         if (status != ASP_MSG_NO_ERR)
965         {
966             TRACE_VERBOSE0("TaskAsip: error in sending SOURCE_SELECT message");
967             SW_BREAKPOINT;            
968         }
969         // receive source select acknowledge message from slave
970         status = AspMsgRcvAck(hAspMsgMaster, ASP_MASTER_DEC_SOURCE_SELECT_DONE, NULL, TRUE);
971         if (status != ASP_MSG_NO_ERR)
972         {
973             TRACE_VERBOSE0("TaskAsip: error in receiving SOURCE_SELECT_DONE ack message");
974             SW_BREAKPOINT;            
975         }
976         
977         // set to unknown so that we can ensure, for IOS purposes, that sourceDecode = NONE
978         // iff we are in this top level state machine and specifically not in decodeProcessing
979         pP->fxns->sourceDecode(pP, pQ, pAsitCfg, PAF_SOURCE_UNKNOWN);
980         
981         TRACE_VERBOSE1(procName[sourceProgram], as+zMS);
983         // Reduce priority level since autodetection complete
984         Task_setPri(pAsitCfg->taskHandle, Task_getPri(pAsitCfg->taskHandle)-1);
985         
986         gAspProfileEnable=1; // enable ASP profiling
987         
988         TRACE_VERBOSE0("TaskAsip: calling decodeProcessing.");
989         errno = pP->fxns->decodeProcessing(pP, pQ, pAsitCfg, sourceSelect);
990         if (errno) 
991         {
992             TRACE_TERSE1("TaskAsip: decodeProcessing returns 0x%x, continue", errno);
993         }
994         else
995         {
996             TRACE_VERBOSE0("TaskAsip: decodeProcessing complete with no error.");
997         }        
999         gAspProfileEnable=0; // disable ASP profiling
1000         
1001         // Increase priority level since decoding complete
1002         Task_setPri(pAsitCfg->taskHandle, Task_getPri(pAsitCfg->taskHandle)+1);
1004         // send dec exit message to slave
1005         status = AspMsgSnd(hAspMsgMaster, ASP_SLAVE_DEC_EXIT, NULL);
1006         if (status != ASP_MSG_NO_ERR)
1007         {
1008             TRACE_VERBOSE0("TaskAsip: error in sending DEC_EXIT message");
1009             SW_BREAKPOINT;                
1010         }
1011         // receive dec exit acknowledge message from slave
1012         status = AspMsgRcvAck(hAspMsgMaster, ASP_MASTER_DEC_EXIT_DONE, NULL, TRUE);
1013         if (status != ASP_MSG_NO_ERR)
1014         {
1015             TRACE_VERBOSE0("TaskAsip: error in receiving DEC_EXIT_DONE ack message");
1016             SW_BREAKPOINT;                
1017         }
1018     } // End of main processing loop for (;;)
1019     
1020     //Log_info0("Exit taskAsipFxn()");
1023 Int PAF_ASIT_ioCompCreate(PAF_AST_IoInp *pIoInp, int numInp, IHeap_Handle iHeapHandle)
1025     int i, j, num_alloc;
1026     lib_mem_rec_t *mem_rec;
1027     ioBuffHandle_t  ioBufHandle;
1028     ioPhyHandle_t   ioPhyHandle;
1029     ioDataHandle_t  ioDataHandle;
1030     Error_Block     eb;
1032     for(i=0; i<numInp; i++)
1033     {
1034         // Create an I/O BUFF instance
1035         // Obtain number of memory blocks required by I/O BUFF
1036         num_alloc = ioBuffNumAlloc();
1038         // Obtain requirements of each memory block
1039         mem_rec   = (lib_mem_rec_t *)malloc(sizeof(lib_mem_rec_t)*num_alloc);
1040         if(ioBuffAlloc(mem_rec) != IOBUFF_NOERR) {
1041             return __LINE__;
1042         }
1044         /* Allocate memory and create I/O BUFF instance */
1045         for(j=0; j<num_alloc; j++) {
1046             mem_rec[j].base = Memory_calloc(iHeapHandle, mem_rec[j].size,
1047                                             (1<<mem_rec[j].alignment), &eb);
1048         }
1050         if(ioBuffCreate(&ioBufHandle, mem_rec) != IOBUFF_NOERR) {
1051             return __LINE__;
1052         }
1054         pIoInp[i].hIoBuff = ioBufHandle;
1056         free(mem_rec);
1058         // Create an I/O PHY instance
1059         // Obtain number of memory blocks required by I/O PHY
1060         num_alloc = ioPhyNumAlloc();
1062         // Obtain requirements of each memory block
1063         mem_rec   = (lib_mem_rec_t *)malloc(sizeof(lib_mem_rec_t)*num_alloc);
1064         if(ioPhyAlloc(mem_rec) != IOBUFF_NOERR) {
1065             return __LINE__;
1066         }
1068         /* Allocate memory and create I/O PHY instance */
1069         for(j=0; j<num_alloc; j++) {
1070             mem_rec[j].base = Memory_calloc(iHeapHandle, mem_rec[j].size,
1071                                             (1<<mem_rec[j].alignment), &eb);
1072         }
1074         if(ioPhyCreate(&ioPhyHandle, mem_rec) != IOBUFF_NOERR) {
1075             return __LINE__;
1076         }
1078         pIoInp[i].hIoPhy = ioPhyHandle;
1080         free(mem_rec);
1082         // Create an I/O DATA instance
1083         // Obtain number of memory blocks required by I/O DATA
1084         num_alloc = ioDataNumAlloc();
1086         // Obtain requirements of each memory block
1087         mem_rec   = (lib_mem_rec_t *)malloc(sizeof(lib_mem_rec_t)*num_alloc);
1088         if(ioDataAlloc(mem_rec) != IOBUFF_NOERR) {
1089             return __LINE__;
1090         }
1092         /* Allocate memory and create I/O DATA instance */
1093         for(j=0; j<num_alloc; j++) {
1094             mem_rec[j].base = Memory_calloc(iHeapHandle, mem_rec[j].size,
1095                                             (1<<mem_rec[j].alignment), &eb);
1096         }
1098         if(ioDataCreate(&ioDataHandle, mem_rec) != IOBUFF_NOERR) {
1099             return __LINE__;
1100         }
1102         pIoInp[i].hIoData = ioDataHandle;
1104         free(mem_rec);
1106     } // end of for loop
1108     return 0;
1109 } // PAF_ASIT_ioCompCreate
1111 // -----------------------------------------------------------------------------
1112 // ASIT Initialization Function - Memory Allocation
1113 //
1114 //   Name:      PAF_ASIT_initPhaseMalloc
1115 //   Purpose:   Audio Stream Input Task Function for initialization of data pointers
1116 //              by allocation of memory.
1117 //   From:      audioStream1Task or equivalent
1118 //   Uses:      See code.
1119 //   States:    x
1120 //   Return:    0 on success.
1121 //              Source code line number on MEM_calloc failure.
1122 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1123 //              * State information as per parent.
1124 //              * Memory allocation errors.
1125 //
1126 Int
1127 PAF_ASIT_initPhaseMalloc(
1128     const PAF_ASIT_Params *pP, 
1129     const PAF_ASIT_Patchs *pQ, 
1130     PAF_ASIT_Config *pAsitCfg
1133     PAF_AST_Config *pAstCfg;
1134     Int as;                    /* Audio Stream Number (1, 2, etc.) */
1135     Int zMS, errLineNum;
1136     Error_Block    eb;
1137         IHeap_Handle   decHeapHandle;
1139     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1140     as = pAstCfg->as;
1141     zMS = pAstCfg->masterStr;
1142     
1143     TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: initialization phase - memory allocation", as+zMS);
1145     // Initialize error block
1146     Error_init(&eb); 
1148     /* Input memory */
1149     if (!(pAstCfg->xInp = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, 
1150         INPUTN * sizeof (*pAstCfg->xInp), 4, &eb)))
1151     {
1152         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
1153         SW_BREAKPOINT;
1154         return __LINE__;
1155     }
1156     TRACE_TERSE3("PAF_ASIT_initPhaseMalloc. (pAstCfg->xInp) %d bytes from space %d at 0x%x.",
1157         INPUTN * sizeof (*pAstCfg->xInp),
1158         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xInp);
1160     /* Input I/O data structure memory */
1161     if (!(pAsitCfg->pIoInp = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM,
1162         INPUTN * sizeof (*pAsitCfg->pIoInp), 4, &eb)))
1163     {
1164         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
1165         SW_BREAKPOINT;
1166         return __LINE__;
1167     }
1168     TRACE_TERSE3("PAF_ASIT_initPhaseMalloc. (pAsitCfg->pIoInp) %d bytes from space %d at 0x%x.",
1169         INPUTN * sizeof (*pAsitCfg->pIoInp),
1170         HEAP_ID_INTERNAL1_SHM, (IArg)pAsitCfg->pIoInp);
1172     /* I/O components memory for input */
1173     errLineNum = PAF_ASIT_ioCompCreate(pAsitCfg->pIoInp, INPUTN, (IHeap_Handle)HEAP_INTERNAL1_SHM);
1174     if(errLineNum)
1175     {
1176         SW_BREAKPOINT;
1177         return errLineNum;
1178     }
1180     /* Decode memory */
1181 #ifdef NON_CACHE_STATUS
1182     decHeapHandle = (IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM;
1183 #else 
1184     decHeapHandle = (IHeap_Handle)HEAP_INTERNAL1_SHM;
1185 #endif
1186     if (!(pAstCfg->xDec = Memory_calloc(decHeapHandle,
1187         DECODEN * sizeof (*pAstCfg->xDec), 4, &eb)))
1188     {
1189         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
1190         SW_BREAKPOINT;
1191         return __LINE__;
1192     }
1194     TRACE_TERSE3("PAF_ASIT_initPhaseMalloc. (pAstCfg->xDec) %d bytes from space %d at 0x%x.",
1195         DECODEN * sizeof (*pAstCfg->xDec),
1196         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xDec);
1197 #if 0
1198     if (!(pAsitCfg->pInpDec = Memory_calloc(decHeapHandle,
1199         DECODEN * sizeof (*pAsitCfg->pInpDec), 4, &eb)))
1200     {
1201         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
1202         SW_BREAKPOINT;
1203         return __LINE__;
1204     }
1205     TRACE_TERSE3("PAF_ASIT_initPhaseMalloc. (pAsitCfg->pInpDec) %d bytes from space %d at 0x%x.",
1206                  DECODEN * sizeof (*pAsitCfg->pInpDec),
1207                  HEAP_ID_INTERNAL1_SHM, (IArg)pAsitCfg->pInpDec);
1208 #endif
1209     TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: initialization phase - memory allocation complete.", as+zMS);
1210     return 0;
1211 } //PAF_ASIT_initPhaseMalloc
1213 // -----------------------------------------------------------------------------
1214 // ASIT Initialization Function - Memory Initialization from Configuration
1215 //
1216 //   Name:      PAF_ASIT_initPhaseConfig
1217 //   Purpose:   Audio Stream Task Function for initialization of data values
1218 //              from parameters.
1219 //   From:      audioStream1Task or equivalent
1220 //   Uses:      See code.
1221 //   States:    x
1222 //   Return:    0 on success.
1223 //              Other as per initFrame0 and initFrame1.
1224 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1225 //              * State information as per parent.
1226 //
1227 Int
1228 PAF_ASIT_initPhaseConfig(
1229     const PAF_ASIT_Params *pP, 
1230     const PAF_ASIT_Patchs *pQ, 
1231     PAF_ASIT_Config *pAsitCfg
1234     PAF_AST_Config *pAstCfg;
1235     Int as;                    /* Audio Stream Number (1, 2, etc.) */
1236     Int z;                     /* input/encode/stream/decode/output counter */
1237     Int zMS;
1239     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1240     as = pAstCfg->as;
1241     zMS = pAstCfg->masterStr;
1242     
1243     TRACE_TERSE1("PAF_ASIT_initPhaseConfig: AS%d: initialization phase - configuration", as+zMS);
1245     //
1246     // Unspecified elements have been initialized to zero during alloc
1247     //
1248     
1249     for (z=INPUT1; z < INPUTN; z++) 
1250     {
1251         pAstCfg->xInp[z].inpBufStatus = *pP->pInpBufStatus;
1252         pAstCfg->xInp[z].inpBufConfig.pBufStatus = &pAstCfg->xInp[z].inpBufStatus;
1253     }
1255     for (z=DECODE1; z < DECODEN; z++) 
1256     {
1257         Int zI = pP->inputsFromDecodes[z];
1258         pAstCfg->xDec[z].decodeControl.size = sizeof(pAstCfg->xDec[z].decodeControl);
1259         pAstCfg->xDec[z].decodeControl.pInpBufConfig = (const PAF_InpBufConfig *)&pAstCfg->xInp[zI].inpBufConfig;
1260     }
1262     TRACE_TERSE1("PAF_ASIT_initPhaseConfig: AS%d: initialization phase - configuration complete.", as+zMS);
1263     return 0;
1264 } //PAF_ASIT_initPhaseConfig
1266 // -----------------------------------------------------------------------------
1267 // ASIT Initialization Function - ACP Algorithm Instantiation
1268 //
1269 //   Name:      PAF_ASIT_initPhaseAcpAlg
1270 //   Purpose:   Audio Stream Input Task Function for initialization of ACP by
1271 //              instantiation of the algorithm.
1272 //   From:      audioStream1Task or equivalent
1273 //   Uses:      See code.
1274 //   States:    x
1275 //   Return:    0 on success.
1276 //              Source code line number on ACP Algorithm creation failure.
1277 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1278 //              * State information as per parent.
1279 //              * Memory allocation errors.
1280 //
1281 Int
1282 PAF_ASIT_initPhaseAcpAlg(
1283     const PAF_ASIT_Params *pP, 
1284     const PAF_ASIT_Patchs *pQ, 
1285     PAF_ASIT_Config *pAsitCfg
1288     PAF_AST_Config *pAstCfg;
1289     Int as;                 /* Audio Stream Number (1, 2, etc.) */
1290     Int z;                  /* input/encode/stream/decode/output counter */
1291     Int betaPrimeOffset;
1292     ACP_Handle acp;
1293     Int zMS;
1294     Int zS, zX;
1296     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1297     as = pAstCfg->as;
1298     zMS = pAstCfg->masterStr;
1299     
1300     TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: initialization phase - ACP Algorithm", as+zMS);
1302     ACP_MDS_init();
1304     if (!(acp = (ACP_Handle)ACP_MDS_create(NULL))) 
1305     {
1306         TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: ACP algorithm instance creation failed", as+zMS);
1307         return __LINE__;
1308     }
1309     pAsitCfg->acp = acp;
1311     ((ALG_Handle)acp)->fxns->algControl((ALG_Handle) acp,
1312         ACP_GETBETAPRIMEOFFSET, (IALG_Status *)&betaPrimeOffset);
1314     for (z=INPUT1; z < INPUTN; z++) 
1315     {
1316         zS = z;
1317         for (zX = DECODE1; zX < DECODEN; zX++) 
1318         {
1319             if (pP->inputsFromDecodes[zX] == z) 
1320             {
1321                 zS = pP->streamsFromDecodes[zX];
1322                 break;
1323             }
1324         }
1325         acp->fxns->attach(acp, ACP_SERIES_STD,
1326             STD_BETA_IB + betaPrimeOffset * (as-1+zS),
1327             (IALG_Status *)&pAstCfg->xInp[z].inpBufStatus);
1328         /* Ignore errors, not reported. */
1329     }
1331     TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: initialization phase - ACP Algorithm complete.", as+zMS);
1333     return 0;
1334 } //PAF_ASIT_initPhaseAcpAlg
1336 // -----------------------------------------------------------------------------
1337 // ASIT Initialization Function - Common Memory
1338 //
1339 //   Name:      PAF_ASIT_initPhaseCommon
1340 //   Purpose:   Audio Stream Input Task Function for allocation of common memory.
1341 //   From:      audioStream1Task or equivalent
1342 //   Uses:      See code.
1343 //   States:    x
1344 //   Return:    0 on success.
1345 //              Source code line number on PAF_ALG_alloc failure.
1346 //              Source code line number on PAF_ALG_mallocMemory failure.
1347 //              Source code line number on Decode Chain initialization failure.
1348 //              Source code line number on ASP Chain initialization failure.
1349 //              Source code line number on Encode Chain initialization failure.
1350 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1351 //              * State information as per parent.
1352 //              * Memory allocation errors.
1353 //
1354 Int
1355 PAF_ASIT_initPhaseCommon(
1356     const PAF_ASIT_Params *pP, 
1357     const PAF_ASIT_Patchs *pQ, 
1358     PAF_ASIT_Config *pAsitCfg
1361     PAF_AST_Config *pAstCfg;
1362     Int as;                     /* Audio Stream Number (1, 2, etc.) */
1363     Int z;                      /* stream counter */
1364     ACP_Handle acp;
1365     PAF_IALG_Config pafAlgConfig;
1366     IALG_MemRec common[3][PAF_IALG_COMMON_MEMN+1];
1367    
1368     acp = pAsitCfg->acp;
1369     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1370     as = pAstCfg->as;
1371     
1372     TRACE_TERSE0("PAF_ASIT_initPhaseCommon: initialization phase - Common Memory");
1374     //
1375     // Determine memory needs and instantiate algorithms across audio streams
1376     //
1377     TRACE_TERSE0("PAF_ASIT_initPhaseCommon: calling PAF_ALG_setup.");
1378     PAF_ALG_setup(&pafAlgConfig, 
1379         HEAP_ID_INTERNAL,               HEAP_INTERNAL, 
1380         HEAP_ID_INTERNAL1,              HEAP_INTERNAL1, 
1381         HEAP_ID_EXTERNAL,               HEAP_EXTERNAL, 
1382         HEAP_ID_INTERNAL1_SHM,          HEAP_INTERNAL1_SHM, 
1383         HEAP_ID_EXTERNAL_SHM,           HEAP_EXTERNAL_SHM, 
1384         HEAP_ID_EXTERNAL_NONCACHED_SHM, HEAP_EXTERNAL_NONCACHED_SHM,
1385         HEAP_CLEAR);
1387     if (pP->fxns->headerPrint)
1388     {
1389         pP->fxns->headerPrint();        
1390     }
1392     for (z = STREAM1; z < STREAMN; z++) 
1393     {
1394         TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: initialization phase - Common Memory", as+z);
1396         //
1397         // Determine common memory for:
1398         //  (1) Logical Input drivers
1399         //
1400         // Decode Algorithms common memory determined in ASP Slave.
1401         //
1402         PAF_ALG_init(common[z], lengthof(common[z]), COMMONSPACE);
1404         //
1405         // Determine common memory needs of Logical Input driver
1406         //
1408         // really need to loop over all inputs for this stream using the tables
1409         // inputsFromDecodes and streamsFromDecodes. But these don't exist for this
1410         // patch, and not needed for FS11, since there is only one input.
1411         if (INPUT1 <= z && z < INPUTN) 
1412         {
1413             TRACE_TERSE2("PAF_ASIT_initPhaseCommon: AS%d: alloc inpLinkInit common[%d]", as+z, z);
1414             if (PAF_ALG_ALLOC(inpLinkInit[z-INPUT1], common[z]))
1415             {
1416                 TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: PAF_ALG_alloc failed", as+z);
1417                 TRACE_TERSE2("failed to alloc %d bytes from space %d", common[z]->size, (IArg)common[z]->space);
1418                 SW_BREAKPOINT;
1419                 return __LINE__;
1420             }
1421             TRACE_TERSE3("alloced %d bytes from space %d at 0x%x", common[z]->size, common[z]->space, (IArg)common[z]->base);
1422             if (pP->fxns->allocPrint)
1423             {
1424                 pP->fxns->allocPrint((const PAF_ALG_AllocInit *)(inpLinkInit[z-INPUT1]), sizeof (*(inpLinkInit[z-INPUT1])), &pafAlgConfig);
1425             }
1426         }
1427     }
1428     {
1429         // Changes made to share scratch between zones
1430         // Assume maximum 3 zones and scratch common memory is at offset 0;
1431         int max=0;
1432         for (z=STREAM1; z<STREAMN; z++)
1433         {
1434             if (max < common[z][0].size)
1435             {
1436                 max = common[z][0].size;
1437             }
1438         }
1439         common[STREAM1][0].size=max;
1440         for (z=STREAM1+1; z<STREAMN; z++)
1441         {
1442             common[z][0].size = 0;            
1443         }
1444     }
1445         
1446     //
1447     // Allocate common memory for:
1448     //  (1) Logical Input drivers
1449     //
1450     for (z = STREAM1; z < STREAMN; z++) 
1451     {
1452         TRACE_TERSE0("PAF_ASIT_initPhaseCommon: calling PAF_ALG_mallocMemory for common space.");
1453         if (PAF_ALG_mallocMemory(common[z], &pafAlgConfig)) 
1454         {
1455             TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: PAF_ALG_mallocMemory failed", as+z);
1456             TRACE_TERSE3("AS%d: z: %d.  Size 0x%x", as+z, z, common[z][0].size);
1457             SW_BREAKPOINT;
1458             return __LINE__;
1459         }
1460         TRACE_TERSE3("alloced %d bytes from space %d at 0x%x", common[z]->size, common[z]->space, (IArg)common[z]->base);
1461         // share zone0 scratch with all zones 
1462         common[z][0].base = common[0][0].base;
1463         if (pP->fxns->commonPrint)
1464         {
1465             pP->fxns->commonPrint(common[z], &pafAlgConfig);
1466         }
1468         //
1469         // Allocate non-common memories for Logical IO drivers
1470         //    Since these structures are used at run-time we allocate from external memory
1471         if (INPUT1 <= z && z < INPUTN) 
1472         {
1473             PAF_ASP_Chain *chain;
1474             TRACE_TERSE2("PAF_ASIT_initPhaseCommon: AS%d: non-common input chain init for %d",
1475                            as+z, z);
1476             chain = PAF_ASP_chainInit(&pAstCfg->xInp[z].inpChainData, pP->pChainFxns,
1477                         HEAP_EXTERNAL, as+z, acp, &trace,
1478                         inpLinkInit[z-INPUT1], NULL, common[z], &pafAlgConfig);
1479             if (!chain) 
1480             {
1481                 TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: Input chain initialization failed", as+z);
1482                 return __LINE__;
1483             }
1484         }
1485     }
1486     TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: Returning complete.", as+z);
1488     return 0;
1489 } //PAF_ASIT_initPhaseCommon
1491 // -----------------------------------------------------------------------------
1492 // ASIT Initialization Function - Algorithm Keys
1493 //
1494 //   Name:      PAF_ASIT_initPhaseAlgKey
1495 //   Purpose:   Audio Stream Input Task Function for initialization of data values
1496 //              from parameters for Algorithm Keys.
1497 //   From:      audioStream1Task or equivalent
1498 //   Uses:      See code.
1499 //   States:    x
1500 //   Return:    0.
1501 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1502 //              * State information as per parent.
1503 //
1504 // .............................................................................
1505 Int
1506 PAF_ASIT_initPhaseAlgKey(
1507     const PAF_ASIT_Params *pP, 
1508     const PAF_ASIT_Patchs *pQ, 
1509     PAF_ASIT_Config *pAsitCfg
1512     PAF_AST_Config *pAstCfg;
1513     Int as;                    /* Audio Stream Number (1, 2, etc.) */
1515     
1516     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1517     as = pAstCfg->as;
1518     (void)as;  // clear compiler warning in case not used with tracing disabled
1520     TRACE_VERBOSE1("PAF_ASIT_initPhaseAlgKey: AS%d: initialization phase - Algorithm Keys", as);
1522     return 0;
1523 } //PAF_ASIT_initPhaseAlgKey
1525 // -----------------------------------------------------------------------------
1526 // ASIT Initialization Function - I/O Devices
1527 //
1528 //   Name:      PAF_ASIT_initPhaseDevice
1529 //   Purpose:   Audio Stream Input Task Function for initialization of I/O Devices.
1530 //   From:      audioStream1Task or equivalent
1531 //   Uses:      See code.
1532 //   States:    x
1533 //   Return:    0 on success.
1534 //              Source code line number on device allocation failure.
1535 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1536 //              * State information as per parent.
1537 //              * Memory allocation errors.
1538 //
1539 Int
1540 PAF_ASIT_initPhaseDevice(
1541     const PAF_ASIT_Params *pP, 
1542     const PAF_ASIT_Patchs *pQ, 
1543     PAF_ASIT_Config *pAsitCfg
1546     PAF_AST_Config *pAstCfg;
1547     Int as;                             /* Audio Stream Number (1, 2, etc.) */
1548     Int z;                              /* input/output counter */
1549     PAF_SIO_IALG_Obj    *pObj;
1550     PAF_SIO_IALG_Config *pAlgConfig;
1551     PAF_IALG_Config pafAlgConfig;
1554     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1555     as = pAstCfg->as;
1556     (void)as; // clear compiler warning in case not used with tracing disabled
1558     TRACE_TERSE1("PAF_ASIT_initPhaseDevice: AS%d: initialization phase - I/O Devices", as);
1560     if (pP->fxns->bufMemPrint)
1561     {
1562         PAF_ALG_setup (&pafAlgConfig, 
1563             HEAP_ID_INTERNAL,               HEAP_INTERNAL, 
1564             HEAP_ID_INTERNAL1,              HEAP_INTERNAL1,
1565             HEAP_ID_EXTERNAL,               HEAP_EXTERNAL,
1566             HEAP_ID_INTERNAL1_SHM,          HEAP_INTERNAL1_SHM,
1567             HEAP_ID_EXTERNAL_SHM,           HEAP_EXTERNAL_SHM,
1568             HEAP_ID_EXTERNAL_NONCACHED_SHM, HEAP_EXTERNAL_NONCACHED_SHM,
1569             HEAP_CLEAR);
1570         TRACE_TERSE2("PAF_ASIT_initPhaseDevice: AS%d: calling PAF_ALG_setup with clear at %d.", as, HEAP_CLEAR);
1571     }
1573     for (z=INPUT1; z < INPUTN; z++) 
1574     {
1575         PAF_InpBufConfig *pConfig = &pAstCfg->xInp[z].inpBufConfig;
1577         pObj = (PAF_SIO_IALG_Obj *)pAstCfg->xInp[z].inpChainData.head->alg;
1578         pAlgConfig = &pObj->config;
1580         pAstCfg->xInp[z].hRxSio = NULL;
1582         pConfig->base.pVoid       = pAlgConfig->pMemRec[0].base;
1583         pConfig->pntr.pVoid       = pAlgConfig->pMemRec[0].base;
1584         pConfig->head.pVoid       = pAlgConfig->pMemRec[0].base;
1585         pConfig->futureHead.pVoid = pAlgConfig->pMemRec[0].base;
1586         pConfig->allocation       = pAlgConfig->pMemRec[0].size;
1587         pConfig->sizeofElement    = 2;
1588         pConfig->precision        = 16;
1590         if (pP->fxns->bufMemPrint)
1591         {
1592             pP->fxns->bufMemPrint(z, pAlgConfig->pMemRec[0].size, PAF_ALG_memSpaceToHeapId(&pafAlgConfig,pAlgConfig->pMemRec[0].space), 0);
1593         }
1594     }
1596     TRACE_TERSE1("PAF_ASIT_initPhaseDevice: AS%d: initialization phase - I/O Devices complete.", as);
1598     return 0;
1599 } //PAF_ASIT_initPhaseDevice
1601 // -----------------------------------------------------------------------------
1602 // ASIT Initialization Function - Decoder Output Circular Buffer
1603 //
1604 //   Name:      PAF_ASIT_initPhaseDecOpCircBuf
1605 //   Purpose:   Audio Stream Input Task Function for initialization of Decoder Output Circular Buffer.
1606 //   From:      audioStream1Task or equivalent
1607 //   Uses:      See code.
1608 //   States:    x
1609 //   Return:    0 on success.
1610 //              Source code line number on device allocation failure.
1611 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1612 //              * State information as per parent.
1613 //              * Memory allocation errors.
1614 //
1615 Int
1616 PAF_ASIT_initPhaseDecOpCircBuf(
1617     const PAF_ASIT_Params *pP, 
1618     const PAF_ASIT_Patchs *pQ, 
1619     PAF_ASIT_Config *pAsitCfg
1622     PAF_AST_Config *pAstCfg;
1623     PAF_AST_DecOpCircBuf *pCb;          /* Decoder output circular buffer */
1624     Int as;                             /* Audio Stream Number (1, 2, etc.) */
1625     Int zMS;
1626     Int z;                              /* decode counter */
1627     Int errno;                          /* error number */
1628     Error_Block    eb;
1629     Int i;
1630     ACP_Handle acp;
1631     Int betaPrimeOffset;
1632     Int zS;
1634     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1635     as = pAstCfg->as;
1636     zMS = pAstCfg->masterStr;
1638     // Decode output circular buffer memory
1639     if (!(pAstCfg->xDecOpCb = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM,
1640         DECODEN * sizeof (*pAstCfg->xDecOpCb), 4, &eb)))
1641     {
1642         TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1643         SW_BREAKPOINT;
1644         return __LINE__;
1645     }
1647     TRACE_TERSE3("PAF_ASIT_initPhaseDecOpCircBuf. (pAsitCfg->xDecOpCb) %d bytes from space %d at 0x%x.",
1648         DECODEN * sizeof (*pAstCfg->xDecOpCb),
1649         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xDecOpCb);
1651     for (z=DECODE1; z < DECODEN; z++)
1652     {
1653         pCb = &pAstCfg->xDecOpCb[z];
1654         
1655         // allocate audio frame circular buffer
1656         if (!(pCb->afCb = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, ASP_DECOP_CB_MAX_NUM_AF * sizeof(PAF_AudioFrame), 4, &eb)))
1657         {
1658             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1659             SW_BREAKPOINT;
1660         }
1661         // allocate audio frame PCM sample pointer array
1662         for (i = 0; i<ASP_DECOP_CB_MAX_NUM_AF; i++)
1663         {
1664             if (!(pCb->afCb[i].data.sample = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, ASP_DECOP_CB_MAX_NUM_PCM_CH_MAT * sizeof(PAF_AudioData *), 4, &eb)))
1665             {
1666                 TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1667                 SW_BREAKPOINT;
1668             }
1669             if (!(pCb->afCb[i].data.samsiz = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, ASP_DECOP_CB_MAX_NUM_PCM_CH_MAT * sizeof(PAF_AudioSize), 4, &eb)))
1670             {
1671                 TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1672                 SW_BREAKPOINT;
1673             }                
1674         }
1675         // allocate PCM sample buffer
1676         if (!(pCb->pcmBuf = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_SHM, ASP_DECOP_CB_PCM_BUF_SZ * sizeof(PAF_AudioData), 4, &eb)))
1677         {
1678             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1679             SW_BREAKPOINT;
1680         }
1681         pCb->pcmBufEnd = pCb->pcmBuf + ASP_DECOP_CB_PCM_BUF_SZ;
1682         // allocate Metadata buffers
1683         if (!(pCb->metaBuf = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_SHM, ASP_DECOP_CB_MAX_NUM_AF * PAF_MAX_PRIVATE_MD_SZ * PAF_MAX_NUM_PRIVATE_MD * sizeof(Int8), 4, &eb)))
1684         {
1685             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1686             SW_BREAKPOINT;
1687         }
1688         pCb->metaBufEnd = pCb->metaBuf + (ASP_DECOP_CB_MAX_NUM_AF * PAF_MAX_PRIVATE_MD_SZ * PAF_MAX_NUM_PRIVATE_MD);
1690         #ifdef CB_RW_OP_CAP_PP // debug
1691         // allocate debug buffer
1692         if (!(pCb->cb_samples_op = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, CB_OP_COUNT_MAX * sizeof(UInt32), 4, &eb)))
1693         {
1694             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1695             SW_BREAKPOINT;
1696         }
1698         // allocate debug buffer
1699         if (!(pCb->cb_op_owner = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, CB_OP_COUNT_MAX * sizeof(UInt8), 4, &eb)))
1700         {
1701             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1702             SW_BREAKPOINT;
1703         }
1705         // allocate debug buffer
1706         if (!(pCb->cb_afRdIdx = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, CB_OP_COUNT_MAX * sizeof(UInt8), 4, &eb)))
1707         {
1708             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1709             SW_BREAKPOINT;
1710         }
1712         // allocate debug buffer
1713         if (!(pCb->cb_afWrtIdx = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, CB_OP_COUNT_MAX * sizeof(UInt8), 4, &eb)))
1714         {
1715             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1716             SW_BREAKPOINT;
1717         }
1719         // allocate debug buffer
1720         if (!(pCb->cb_numAfCb = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, CB_OP_COUNT_MAX * sizeof(UInt8), 4, &eb)))
1721         {
1722             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1723             SW_BREAKPOINT;
1724         }
1725         #endif
1726     }
1728     for (z = DECODE1; z < DECODEN; z++)
1729     {
1730         //
1731         // Initialize decoder output circular
1732         //
1733         
1734         // Initialize status
1735         pAstCfg->xDecOpCb[z].cbStatus = *pP->z_pDecOpCircBufStatus[z];
1736         
1737         // Default initialization
1738         errno = cbInit(pCb);
1739         if (errno)
1740         {
1741             //SW_BREAKPOINT; // debug
1742             return errno;
1743         }
1744     }
1745     
1746     // Get ASIT ACP handle
1747     acp = pAsitCfg->acp;
1748     if (!acp)
1749     {
1750         TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: ACP algorithm instance creation  failed", as+zMS);
1751         return __LINE__;
1752     }
1753     
1754     // Get Beta Prime offset
1755     ((ALG_Handle)acp)->fxns->algControl((ALG_Handle) acp,
1756         ACP_GETBETAPRIMEOFFSET, (IALG_Status *)&betaPrimeOffset);
1757             
1758     for (z = DECODE1; z < DECODEN; z++)
1759     {
1760         // ACP attach CB
1761         zS = pP->streamsFromDecodes[z];
1762         acp->fxns->attach(acp, ACP_SERIES_STD,
1763             STD_BETA_DECOPCB + betaPrimeOffset * (as-1+zS),
1764             (IALG_Status *)&pAstCfg->xDecOpCb[z].cbStatus);        
1765     }
1766             
1767     return 0;
1768 } //PAF_ASIT_initPhaseDecOpCircBuf
1771 // -----------------------------------------------------------------------------
1772 // ASIT Initialization Function - Output Init-Sync
1773 //
1774 //   Name:      PAF_ASIT_initPhaseOutIS
1775 //   Purpose:   Audio Stream Input Task Function for initialization of Output Init-Sync.
1776 //
1777 Int
1778 PAF_ASIT_initPhaseOutIS(
1779     const PAF_ASIT_Params *pP, 
1780     const PAF_ASIT_Patchs *pQ, 
1781     PAF_ASIT_Config *pAsitCfg
1784     PAF_AST_Config *pAstCfg;
1785     Int as;                             /* Audio Stream Number (1, 2, etc.) */
1786     Int z;                              /* decode counter */
1787     PAF_AST_OutInitSyncInfo *pOutISI;
1788     Error_Block    eb;
1789     Int i;
1792     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1793     as = pAstCfg->as;
1794     
1795     /* Output Init-Sync memory */
1796     if (!(pAstCfg->xOutIsi = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, 
1797         DECODEN * sizeof (*pAstCfg->xOutIsi), 4, &eb)))
1798     {
1799         TRACE_TERSE1("PAF_ASIT_initPhaseOutIS: AS%d: Memory_calloc failed", as);
1800         SW_BREAKPOINT;
1801         return __LINE__;
1802     }
1804     // Reset all decoder stage flags
1805     for (z=DECODE1; z < DECODEN; z++)
1806     {
1807         // Get address of Output Init-Sync Info
1808         pOutISI = &pAstCfg->xOutIsi[z];
1809         for (i = 0; i < ASP_OUTIS_NUM_DEC_STAGES; i++)
1810         {
1811             // Reset flag value
1812             pOutISI->decStageOutInitSyncInfo[i].decFlag = 0;
1813         }
1814     }    
1815     
1816     return 0;
1817 } // PAF_ASIT_initPhaseOutIS
1820 #if 0
1821 // -----------------------------------------------------------------------------
1822 // AST Processing Function - Pass-Through Processing
1823 //
1824 //   Name:      PAF_AST_passProcessing
1825 //   Purpose:   Audio Stream Task Function for processing audio data as a
1826 //              pass-through from the input driver to the output driver
1827 //              for development and testing.
1828 //   From:      audioStream1Task or equivalent
1829 //   Uses:      See code.
1830 //   States:    x
1831 //   Return:    Error number in standard form (0 on success).
1832 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1833 //              * State information on initialization.
1834 //              * State information on processing.
1835 //
1837 #pragma CODE_SECTION(PAF_AST_passProcessing,".text:_PAF_AST_passProcessing")
1838 /* Pass Processing is often omitted from builds to save memory, */
1839 /* and CODE_SECTION/clink constructs facilitate this omission.  */
1841 Int
1842 PAF_AST_passProcessing(const PAF_AST_Params *pP, const PAF_AST_Patchs *pQ, PAF_AST_Config *pC, Int hack)
1844     Int z;                              /* input/output counter */
1845     Int errno = 0;                      /* error number */
1846     Int getVal;
1847     Int rxNumChan, txNumChan;
1848     Int first;
1849     Int zMD = pC->masterDec;
1850     Int zMI = pP->zone.master;
1853 #ifndef __TI_EABI__
1854     asm (" .clink"); /* See comment above regarding CODE_SECTION/clink. */
1855 #endif    
1857     TRACE_VERBOSE0("PAF_AST_passProcessing: initializing");
1859     //
1860     // Determine that receive/transmit channels are compatible
1861     //
1863     // Can handle handle only master input
1864     for (z=INPUT1; z < INPUTN; z++) {
1865         if (z != zMI && pC->xInp[z].hRxSio)
1866             return (ASPERR_PASS + 0x01);
1867     }
1869     /* Number of receive/transmit channels */
1871     if (! pC->xInp[zMI].hRxSio)
1872         return (ASPERR_PASS + 0x11);
1873     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &rxNumChan))
1874         return (ASPERR_PASS + 0x12);
1875     if (rxNumChan > NUM_TX_CHAN(zMI))
1876         return (ASPERR_PASS + 0x13);
1878     for (z=OUTPUT1; z < OUTPUTN; z++) {
1879         if (! pC->xOut[zMI].hTxSio)
1880             return (ASPERR_PASS + 0x10*(z+2) + 0x01);
1881         if (SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &txNumChan))
1882             return (ASPERR_PASS + 0x10*(z+2) + 0x02);
1883         if (txNumChan > NUM_TX_CHAN(zMI))
1884             return (ASPERR_PASS + 0x10*(z+2) + 0x03);
1885     }
1887     //
1888     // Set up receive/transmit
1889     //
1891     SIO_idle (pC->xInp[zMI].hRxSio);
1892     for (z=OUTPUT1; z < OUTPUTN; z++) {
1893         if(SIO_idle (pC->xOut[z].hTxSio))
1894             return ASPERR_IDLE;
1895     }
1897     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_SET_SOURCESELECT, PAF_SOURCE_PCM))
1898         return (ASPERR_PASS + 0x14);
1900     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, FRAMELENGTH))
1901         return (ASPERR_PASS + 0x15);
1903     for (z=OUTPUT1; z < OUTPUTN; z++)
1904         pC->xOut[z].outBufConfig.lengthofFrame = FRAMELENGTH;
1906     if (SIO_issue (pC->xInp[zMI].hRxSio, &pC->xInp[zMI].inpBufConfig, sizeof (pC->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_SYNC))
1907         return ASPERR_PASS + 0x16;
1909     if (SIO_reclaim (pC->xInp[zMI].hRxSio, (Ptr)&pC->xInp[zMI].pInpBuf, NULL) != sizeof (PAF_InpBufConfig))
1910         return ASPERR_PASS + 0x17;
1912     //
1913     // Receive and transmit the data in single-frame buffers
1914     //
1916     first = 1;
1917     while (pC->xDec[zMD].decodeStatus.sourceSelect == PAF_SOURCE_PASS) {
1918         PAF_OutBufConfig *pOutBuf;
1919         PAF_InpBufConfig *pInpBuf;
1921         if (first) {
1922             first = 0;
1924             TRACE_VERBOSE0("PAF_AST_passProcessing: starting output");
1926             for (z=OUTPUT1; z < OUTPUTN; z++) {
1927                 getVal = SIO_issue (pC->xOut[z].hTxSio, &pC->xOut[z].outBufConfig, sizeof(pC->xOut[z].outBufConfig), 0);
1928                 if (getVal > 0) {
1929                     errno = ASPERR_ISSUE;
1930                     break;
1931                 }
1932                 else if (getVal < 0) {
1933                     errno = -getVal;
1934                     break;
1935                 }
1937                 if (getVal = SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_UNMUTE, 0))
1938                     return (getVal & 0xff) | ASPERR_MUTE;
1939             }
1940             if (errno)
1941                 break;
1943         }
1945         getVal = SIO_issue (pC->xInp[zMI].hRxSio, &pC->xInp[zMI].inpBufConfig, sizeof (pC->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME);
1946         if (getVal > 0) {
1947             errno = ASPERR_ISSUE;
1948             break;
1949         }
1951         TRACE_VERBOSE1("PAF_AST_passProcessing: awaiting frame -- input size %d", rxNumChan * FRAMELENGTH);
1953         getVal = SIO_reclaim (pC->xInp[zMI].hRxSio, (Ptr) &pInpBuf, NULL);
1954         if (getVal < 0) {
1955             errno = -getVal;
1956             break;
1957         }
1959         for (z=OUTPUT1; z < OUTPUTN; z++) {
1960             getVal = SIO_reclaim (pC->xOut[z].hTxSio, (Ptr) &pOutBuf, NULL);
1961             if (getVal < 0) {
1962                 errno = -getVal;
1963                 break;
1964             }
1965         }
1966         if( errno )
1967             break;
1969         TRACE_VERBOSE0("PAF_AST_passProcessing: copying frame");
1971         if (errno = pP->fxns->passProcessingCopy (pP, pQ, pC))
1972             break;
1974         for (z=OUTPUT1; z < OUTPUTN; z++) {
1975             getVal = SIO_issue (pC->xOut[z].hTxSio, &pC->xOut[z].outBufConfig, sizeof(pC->xOut[z].outBufConfig), 0);
1976             if (getVal > 0) {
1977                 errno = ASPERR_ISSUE;
1978                 break;
1979             }
1980             else if (getVal < 0) {
1981                 errno = -getVal;
1982                 break;
1983             }
1984         }
1985         if( errno )
1986             break;
1987     }
1989     //
1990     // Close down receive/transmit
1991     //
1993     TRACE_TERSE0("PAF_AST_passProcessing: finalizing"));
1995     for (z=OUTPUT1; z < OUTPUTN; z++) {
1996         if (getVal = SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_MUTE, 0)) {
1997             if (! errno)
1998                 errno = (getVal & 0xff) | ASPERR_MUTE;
1999             /* convert to sensical errno */
2000         }
2001     }
2003     SIO_idle (pC->xInp[zMI].hRxSio);
2004     for (z=OUTPUT1; z < OUTPUTN; z++)
2005         SIO_idle (pC->xOut[z].hTxSio);
2007     return errno;
2009 } //PAF_AST_passProcessing
2010 #endif // #if 0
2012 #if 0
2013 // -----------------------------------------------------------------------------
2014 // AST Processing Function Helper - Pass-Through Processing Patch Point
2015 //
2016 //   Name:      PAF_AST_passProcessingCopy
2017 //   Purpose:   Pass-Through Processing Function for copying audio data
2018 //              from the input buffer to the output buffer.
2019 //   From:      AST Parameter Function -> passProcessing
2020 //   Uses:      See code.
2021 //   States:    x
2022 //   Return:    Error number in standard form (0 on success).
2023 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2024 //              x
2025 //
2027 #pragma CODE_SECTION(PAF_AST_passProcessingCopy,".text:_PAF_AST_passProcessingCopy")
2028 /* Pass Processing is often omitted from builds to save memory, */
2029 /* and CODE_SECTION/clink constructs facilitate this omission.  */
2031 Int
2032 PAF_AST_passProcessingCopy (const PAF_AST_Params *pP, const PAF_AST_Patchs *pQ, PAF_AST_Config *pC)
2034     Int z;                              /* output counter */
2035     Int errno;                          /* error number */
2036     Int i;
2037     Int rxNumChan, txNumChan;
2038     Int zMI = pP->zone.master;
2041     asm (" .clink"); /* See comment above regarding CODE_SECTION/clink. */
2043     // Copy data from input channels to output channels one of two ways:
2045     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &rxNumChan))
2046         return (ASPERR_PASS + 0x12);
2048     for (z=OUTPUT1; z < OUTPUTN; z++) {
2049         if (SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &txNumChan))
2050             return (ASPERR_PASS + 0x22);
2052         if( txNumChan <= rxNumChan ) {
2054             // Copy one to one, ignoring later rx channels as needed.
2056             for( i=0; i < txNumChan; i++ ) {
2057                 errno = pP->fxns->copy( i, &pC->xInp[zMI].inpBufConfig, i, &pC->xOut[z].outBufConfig );
2058                 if( errno )
2059                     return errno;
2060             }
2061         }
2062         else {
2064             // Copy one to many, repeating earlier rx channels as needed.
2066             Int from, to;
2068             from = 0;
2069             to   = 0;
2070             while( to < txNumChan ) {
2071                 errno = pP->fxns->copy( from, &pC->xInp[zMI].inpBufConfig, to, &pC->xOut[z].outBufConfig );
2072                 if( errno )
2073                     return errno;
2075                 from++;
2076                 to++;
2077                 if( from == rxNumChan )
2078                     from = 0;
2079             }
2080         }
2081     }
2083     return 0;
2084 } //PAF_AST_passProcessingCopy
2085 #endif // #if 0
2087 // -----------------------------------------------------------------------------
2088 // ASIT Processing Function - Auto Processing
2089 //
2090 //   Name:      PAF_ASIT_autoProcessing
2091 //   Purpose:   Audio Stream Input Task Function for processing audio data to
2092 //              determine the input type without output.
2093 //   From:      audioStream1Task or equivalent
2094 //   Uses:      See code.
2095 //   States:    x
2096 //   Return:    Error number in standard or SIO form (0 on success).
2097 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2098 //              * State information on initialization.
2099 //
2101 #define DECSIOMAP(X)                                                \
2102     pP->pDecSioMap->map[(X) >= pP->pDecSioMap->length ? 0 : (X)]
2104 Int
2105 PAF_ASIT_autoProcessing(
2106     const PAF_ASIT_Params *pP, 
2107     const PAF_ASIT_Patchs *pQ, 
2108     PAF_ASIT_Config *pAsitCfg, 
2109     Int inputTypeSelect, 
2110     ALG_Handle pcmAlgMaster
2113     PAF_AST_Config *pAstCfg;
2114     Int as;                 /* Audio Stream Number (1, 2, etc.) */
2115     Int errno = 0;          /* error number */
2116     Int nbytes;
2117     Int frameLength;
2118     Int zMD;
2119     Int zMI;
2120     Int zMS;
2121     
2122     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
2123     as = pAstCfg->as;
2124     zMD = pAstCfg->masterDec;
2125     zMS = pAstCfg->masterStr;    
2126     zMI = pP->zone.master;    
2127     
2128     TRACE_VERBOSE1("PAF_ASIT_autoProcessing: AS%d: PAF_AST_autoProcessing", as+zMS);
2130     if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio,
2131                          PAF_SIO_CONTROL_SET_SOURCESELECT,
2132                          DECSIOMAP(pAstCfg->xDec[zMD].decodeStatus.sourceSelect)))
2133     {
2134         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: AS%d: source select returns 0x%x", as+zMS, errno);
2135         return errno;
2136     }
2137     
2138     frameLength = FRAMELENGTH; // fix PCM frameLength
2139     if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio,
2140                          PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, frameLength))
2141     {
2142         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: SET_PCMFRAMELENGTH returns 0x%x, returning ASPERR_AUTO_LENGTH, 0x%x",
2143             errno, ASPERR_AUTO_LENGTH);
2144         return ASPERR_AUTO_LENGTH;
2145     }
2147     if (errno = SIO_issue(pAstCfg->xInp[zMI].hRxSio,
2148                           &pAstCfg->xInp[zMI].inpBufConfig, sizeof(pAstCfg->xInp[zMI].inpBufConfig),
2149                           PAF_SIO_REQUEST_SYNC))
2150     {
2151         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: REQUEST_SYNC returns 0x%x, returning ASPERR_ISSUE, 0x%x",
2152             errno, ASPERR_ISSUE);
2153         return ASPERR_ISSUE;
2154     }
2156     TRACE_VERBOSE1("PAF_ASIT_autoProcessing: AS%d: awaiting sync", as+zMS);
2158     // all of the sync scan work is done in this call. If the error returned
2159     // is DIBERR_SYNC then that just means we didn't find a sync, not a real I/O
2160     // error so we mask it off.
2161     nbytes = SIO_reclaim(pAstCfg->xInp[zMI].hRxSio, (Ptr)&pAstCfg->xInp[zMI].pInpBuf, NULL);
2162     if (nbytes == -DIBERR_SYNC)
2163     {
2164 #if 0 // debug
2165         // Shows timing of autosync restart
2166         // ADC B5
2167         {
2168             static Uint8 toggleState = 0;
2169             if (toggleState == 0)
2170                 GPIOSetOutput(GPIO_PORT_0, GPIO_PIN_99);
2171             else
2172                 GPIOClearOutput(GPIO_PORT_0, GPIO_PIN_99);
2173             toggleState = ~(toggleState);
2174         }
2175 #endif                
2176         TRACE_TERSE2("PAF_ASIT_autoProcessing: AS%d: SIO_reclaim returned 0x%x, ignoring", as+zMS, nbytes);
2177         return nbytes;
2178     }
2179     if (nbytes != sizeof(PAF_InpBufConfig))
2180     {
2181         TRACE_TERSE3("PAF_ASIT_autoProcessing. SIO_reclaim returned %d, not %d, returning ASPERR_RECLAIM (0x%x)",
2182             nbytes, sizeof(PAF_InpBufConfig), ASPERR_RECLAIM);
2183         return ASPERR_RECLAIM;
2184     }
2185     if (errno)
2186     {
2187         TRACE_TERSE2("PAF_ASIT_autoProcessing: AS%d: returning errno 0x%x", as+zMS, errno);
2188     }
2189     return errno;
2190 } //PAF_ASIT_autoProcessing
2192 UInt32 gProbe1Err=0;
2193 UInt32 gProbe2Err=0;
2194 UInt32 gMajorAuMissed=0;
2196 // -----------------------------------------------------------------------------
2197 // ASIT Processing Function - Decode Processing
2198 //
2199 //   Name:      PAF_ASIT_decodeProcessing
2200 //   Purpose:   Audio Stream Input Task Function for processing audio data.
2201 //   From:      audioStream1Task or equivalent
2202 //   Uses:      See code.
2203 //   States:    x
2204 //   Return:    Error number in standard form (0 on success).
2205 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2206 //              * State information on initialization (via children).
2207 //              * State information on processing (via children).
2208 //              * Decode warnings.
2209 //
2210 // When "writeDECModeContinuous" is used for zMI input/decode:
2211 // PAF_AST_decodeProcessing() loop may be (is designed to be) exited:
2212 // (a) if "writeDECCommandRestart" is used
2213 //    (or "writeDECCommandAbort", but this performs no cleanup whatsoever, and so its use is discouraged)
2214 // (b) if "writeDECSourceSelectNone" is used
2215 // [ the latter events lead to QUIT state, simply for exiting (errme = errno = ASPERR_QUIT)
2216 // (c) if an error occurs in
2217 //     INIT
2218 //     CONT ("subsequent block state", which "Establish[es] secondary timing")
2219 //         -> PAF_AST_decodeCont(): "Await slave inputs"
2220 //     STREAM (errno |= PAF_COMPONENT_ASP)
2221 //     ENCODE (errno |= PAF_COMPONENT_ENCODE)
2222 // [ the latter errors lead to "switch_break:"
2223 //         -> PAF_AST_decodeComplete(), which always returns 0 (no error) ]
2224 //
2225 // [ Notably, in FINAL ("frame-finalization state")
2226 //         -> PAF_AST_decodeFinalTest() is *not* called,
2227 //   and so any other (asynchronous) changes in pC->xDec[zMD].decodeStatus.sourceSelect are ignored. ]
2228 // [ For completeness, note also: "default" state, internal check (errme = errno = ASPERR_UNKNOWNSTATE) ]
2229 //
2230 // States in which error can't occur:
2231 //     AGAIN ("subsequent initial state")
2232 //
2233 // States in which (some) errors must be handled:
2234 //     INFO1 ("first frame state")
2235 //         -> PAF_AST_decodeInfo(): pass on ASPERR_INFO_RATECHANGE, ASPERR_INFO_PROGRAM ("bad" internal error)
2236 //            -> *DONE* must "catch" ASPERR_RECLAIM from SIO_reclaim (pC->xInp[zMI].hRxSio) -- note zMI only **
2237 //               ?*? but what about ASPERR_RESYNC from same call ?*?
2238 //            -> *for now, at least, pass on error from pP->fxns->updateInputStatus ()*
2239 //            -> *DONE* must "catch" error from (zMI) dec->fxns->info() **
2240 //         -> PAF_AST_decodeInfo1(): pass on any errors which occur here:
2241 //            - pP->fxns->streamChainFunction (... PAF_ASP_CHAINFRAMEFXNS_RESET)
2242 //            - enc->fxns->info()
2243 //            - pP->fxns->setCheckRateX()
2244 //            - pP->fxns->startOutput()
2245 //            - "Start slave inputs if necessary"
2246 //     INFO2 ("subsequent frame state")
2247 //         -> PAF_AST_decodeInfo(): (see above)
2248 //         -> PAF_AST_decodeInfo2(): pass on any errors which occur here:
2249 //            - pP->fxns->setCheckRateX()
2250 //     TIME ("timing state")
2251 //         -> PAF_AST_decodeTime(): "Special timing consideations for AC-3"
2252 //         -> performs SIO_issue (... PAF_SIO_REQUEST_FULLFRAME) & SIO_reclaim() *for zMI only*
2253 //         -> now, DIB_issue [PAF_SIO_REQUEST_FULLFRAME] would only return SYS_EINVAL for "bad" internal error
2254 //            (*OK* don't try to recover from this*)
2255 //         -> much more likely would be SIO_reclaim() error (ASPERR_RECLAIM)
2256 //         -> *DONE* must "catch" (just) ASPERR_RECLAIM error -- note zMI only,
2257 //            possibly in PAF_AST_decodeProcessing() itself **
2258 //     DECODE ("decode state")
2259 //         -> PAF_AST_decodeDecode(): pass on error from
2260 //            - PAF_SIO_CONTROL_GET_NUM_REMAINING ("bad" internal error)
2261 //            - dec->fxns->reset()
2262 //            - PAF_SIO_CONTROL_SET_PCMFRAMELENGTH
2263 //         -> *DONE* must catch error from (zMI) dec->fxns->decode()
2264 //         -> *?* must catch ASPERR_ISSUE from (zMI) SIO_issue()
2265 Int
2266 PAF_ASIT_decodeProcessing(
2267     const PAF_ASIT_Params *pP, 
2268     const PAF_ASIT_Patchs *pQ, 
2269     PAF_ASIT_Config *pAsitCfg, 
2270     Int sourceSelect
2273     PAF_AST_Config *pAstCfg;
2274     //Int as = pAsitCfg->as;              /* Audio Stream Number (1, 2, etc.) */
2275     Int z;                              /* decode counter */
2276     Int errno;                          /* error number */
2277     Int getVal;
2278     enum { INIT, INFO1, INFO2, DECODE, FINAL, QUIT } state;
2279     ALG_Handle alg[DECODEN_MAX];
2280     Int zMD;
2281     //Int zMS;
2282     Int frame; // decoder input frame count
2283     Int block; // decoder output block count / input frame
2284     Int8 tempVar8, temp2Var8;
2285     
2286     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
2287     zMD = pAstCfg->masterDec;
2288     //zMS = pAstCfg->masterStr;
2289         
2290     for (z=DECODE1; z < DECODEN; z++)
2291     {
2292         alg[z] = pAstCfg->xDec[z].decAlg[PAF_SOURCE_PCM];        
2293     }
2294     alg[zMD] = NULL; // decAlgMaster; // alg[] init is on slave
2296     //
2297     // Receive and process the data in single-frame buffers
2298     //
2300     state = INIT;
2301     errno = 0; /* error number */
2303     tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceSelect), 
2304                                  GATEMP_INDEX_DEC);
2305     TRACE_TERSE1("PAF_ASIT_decodeProcessing: sourceSelect is %d", tempVar8);
2307     for (;;) 
2308     {
2309         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceSelect), 
2310                                      GATEMP_INDEX_DEC);
2311         if (tempVar8 == PAF_SOURCE_NONE)
2312         {
2313             TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: sourceSelect == PAF_SOURCE_NONE");
2314             state = QUIT;
2315         }
2317         // Process commands (decode)
2318         getVal = pP->fxns->decodeCommand(pP, pQ, pAsitCfg);
2319         if (getVal) 
2320         {
2321             if (state != INIT)   // no need to restart/abort if not yet started
2322             {
2323                 if (getVal == ASPERR_QUIT)
2324                 {
2325                     state = QUIT;
2326                     TRACE_VERBOSE0("PAF_ASIT_decodeProcessing. %d: state = QUIT");
2327                 }
2328                 else if (getVal == ASPERR_ABORT)
2329                 {
2330                     TRACE_VERBOSE0("PAF_ASIT_decodeProcessing. %d: return getVal");
2331                     
2332                     // PFP end -- outside of PFP for errors, EOS, or Input SIO change
2333                     pfpEnd(PFP_ID_ASIT_2, PFP_FINISH_MEAS);
2334                     gNumPfpAsit2--;
2335                     
2336                     return getVal;
2337                 }
2338                 else
2339                 {
2340                     /* ignore */;
2341                 }
2342             }
2343             TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state == INIT");
2344         }
2346         TRACE_TIME((&TIME_MOD,         "... + %d = %d ->", dtime(), TSK_time()));
2347         TRACE_TIME((&TIME_MOD,         "                 state = %s", stateName[state]));
2349         // Process state (decode)
2350         switch (state) 
2351         {
2352             case INIT: // initial state
2353                 gAsipInitCnt++;
2354                 Log_info0("TaskAsip: state=INIT");               
2356                 errno = pP->fxns->decodeInit(pP, pQ, pAsitCfg, sourceSelect);
2357                 if (errno)
2358                 {
2359                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INIT, errno 0x%x.  break after decodeInit", errno);
2360                     break;
2361                 }
2362                                
2363                 frame = 0;
2364                 block = 0;
2366                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INIT->INFO1");
2367                 state = INFO1;
2368                 continue;
2370             case INFO1: // first frame state
2371                 gAsipInfo1Cnt++;
2372                 Log_info0("TaskAsip: state=INFO1");
2373                 
2374                 // Establish primary timing
2375                 errno = pP->fxns->decodeInfo(pP, pQ, pAsitCfg, frame, block);
2376                 if (errno)
2377                 {
2378                     gAsipInfo1_PrimaryErrCnt++;
2379                     TRACE_TERSE1("INFO1: errno 0x%x after decodeInfo, primary timing", errno);
2380                     break;
2381                 }
2382                 
2383                 tempVar8  = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceDecode),
2384                                               GATEMP_INDEX_DEC);
2385                 temp2Var8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sampleRate), 
2386                                               GATEMP_INDEX_DEC);
2387                 // Don't start decode until major access unit is found.
2388                 if (((tempVar8 == PAF_SOURCE_THD)    ||
2389                      (tempVar8 == PAF_SOURCE_DXP)    ||
2390                      (tempVar8 == PAF_SOURCE_DTSHD)) &&
2391                      (temp2Var8 == PAF_SAMPLERATE_UNKNOWN)) 
2392                 {
2393                     Int z;
2394                     for (z=DECODE1; z < DECODEN; z++) 
2395                     {
2396                         Int zI = pP->inputsFromDecodes[z];
2397                         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.mode), 
2398                                                      GATEMP_INDEX_DEC);
2399                         if (pAstCfg->xInp[zI].hRxSio && tempVar8)
2400                         {
2401                             TRACE_VERBOSE0("TaskAsip: PAF_ASIT_decodeProcessing: INFO1, SIO_issue");
2402                             if (SIO_issue(pAstCfg->xInp[zI].hRxSio, &pAstCfg->xInp[zI].inpBufConfig,
2403                                 sizeof(pAstCfg->xInp[zI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME))
2404                             {
2405                                 gProbe2Err++;
2406                                 TRACE_TERSE0("PAF_ASIT_decodeProcessing. %d: INFO1, return (ASPERR_ISSUE)");
2407                                 
2408                                 // PFP end -- outside of PFP for errors, EOS, or Input SIO change
2409                                 pfpEnd(PFP_ID_ASIT_2, PFP_FINISH_MEAS);
2410                                 gNumPfpAsit2--;
2411                                 
2412                                 return (ASPERR_ISSUE);
2413                             }
2414                         }
2415                     }
2416                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1: frame %d, not major access unit", frame);
2417                     gMajorAuMissed++; // debug
2418                     frame++;
2419                     state = INFO1;
2420                     continue;
2421                 }
2422                 TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1: frame %d, major access unit found", frame);
2424                 // Establish secondary timing
2425                 errno = pP->fxns->decodeInfo1(pP, pQ, pAsitCfg, frame, block);
2426                 if (errno)
2427                 {
2428                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1, errno 0x%x.  break after decodeInfo1", errno);
2429                     gAsipInfo1_ErrCnt++;
2430                     break;
2431                 }
2433                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INFO1->DECODE");
2434                 state = DECODE;
2435                 continue;
2437             case INFO2: // subsequent frame state
2438                 gAsipInfo2Cnt++;
2439                 Log_info0("TaskAsip: state=INFO2");
2441                 // Establish primary timing
2442                 errno = pP->fxns->decodeInfo(pP, pQ, pAsitCfg, frame, block);
2443                 if (errno)
2444                 {
2445                     TRACE_TERSE1("PAF_ASIT_decodeProcessing: INFO2 break on decodeInfo. errno 0x%x", errno);
2446                     gAsipInfo2_PrimaryErrCnt++;
2447                     break;
2448                 }
2449                                 
2450                 // Measure cycles in decode processing loop.
2451                 // Only measures cycles spent in loop.
2452                 pfpEnd(PFP_ID_ASIT_2, PFP_FINISH_MEAS);         // PFP end
2453                 gNumPfpAsit2--;
2454                 pfpBegin(PFP_ID_ASIT_2, pAsitCfg->taskHandle);  // PFP begin
2455                 gNumPfpAsit2++;
2457                 errno = pP->fxns->decodeInfo2(pP, pQ, pAsitCfg, frame, block);
2458                 if (errno)
2459                 {
2460                     TRACE_TERSE1("PAF_ASIT_decodeProcessing. %d: INFO2 break on decodeInfo2. errno 0x%x", errno);
2461                     gAsipInfo2_ErrCnt++;
2462                     break;
2463                 }
2464                
2465                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INFO2->DECODE");
2466                 state = DECODE;
2467                 continue;
2469             case DECODE: // decode state
2470                 gAsipDecodeCnt++;
2471                 Log_info0("TaskAsip: state=DECODE");
2473                 errno = pP->fxns->decodeDecode(pP, pQ, pAsitCfg, sourceSelect, frame, block);
2474                 if (errno)
2475                 {
2476                     gAsipDecodeErrCnt++;
2477                     TRACE_TERSE1("PAF_ASIT_decodeProcessing: state: DECODE.  decodeDecode err 0x%04x", errno);
2478                     break;
2479                 }
2480                 
2481                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: DECODE->FINAL");
2482                 state = FINAL;
2483                 continue;
2485             case FINAL: // frame-finalization state
2486                 gAsipFinalCnt++;
2487                 Log_info0("TaskAsip: state=FINAL");
2489                 // Check for final frame, and if indicated:
2490                 // - Exit state machine to "complete" processing.
2491                 if (pP->fxns->decodeFinalTest(pP, pQ, pAsitCfg, frame, block)) 
2492                 {
2493                     break;
2494                 }
2496                 frame++;
2497                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: FINAL->AGAIN");
2498                 state = INFO2;
2499                 continue;
2501             case QUIT: // exit state
2502                 gAsipQuitCnt++;
2503                 Log_info0("TaskAsip: state=QUIT");
2505                 // Quit:
2506                 // - Set error number registers.
2507                 // - Exit state machine to "decode complete" processing.
2508                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: QUIT");
2509                 errno = ASPERR_QUIT;
2510                 break;
2512             default: // unknown state
2514                 // Unknown:
2515                 // - Set error number registers.
2516                 // - Exit state machine to "decode complete" processing.
2518                 TRACE_TERSE1("PAF_ASIT_decodeProcessing: state: unknown, 0x%x", state);
2519                 errno = ASPERR_UNKNOWNSTATE;
2520                 break;
2522         }  // End of switch (state).
2524         TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: Calling decode complete");
2525         if (pP->fxns->decodeComplete(pP, pQ, pAsitCfg, alg, frame, block))
2526         {
2527             /* ignored? */;
2528         }
2529         
2530         TRACE_TIME((&TIME_MOD, "as1-f2: ... + %d = ?? (final? %d)", dtime(), state == FINAL));
2532         // PFP end -- outside of PFP for errors, EOS, or Input SIO change
2533         //pfpEnd(PFP_ID_ASIT_2, PFP_FINISH_MEAS);
2534         //gNumPfpAsit2--;
2535         
2536         //return errno;
2537         break;
2538     }  // End of for (;;) to Receive, process, and transmit the data.
2539     
2540     // PFP end -- outside of PFP for errors, EOS, or Input SIO change
2541     pfpEnd(PFP_ID_ASIT_2, PFP_FINISH_MEAS);
2542     gNumPfpAsit2--;
2543     
2544     return errno;
2545 } //PAF_ASIT_decodeProcessing
2547 // -----------------------------------------------------------------------------
2548 // ASIT Decoding Function - Decode Command Processing
2549 //
2550 //   Name:      PAF_ASIT_decodeCommand
2551 //   Purpose:   Decoding Function for processing Decode Commands.
2552 //   From:      AST Parameter Function -> decodeProcessing
2553 //   Uses:      See code.
2554 //   States:    x
2555 //   Return:    Error number in standard form (0 on success).
2556 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2557 //              * Command execution.
2558 //
2560 Int
2561 PAF_ASIT_decodeCommand(
2562     const PAF_ASIT_Params *pP, 
2563     const PAF_ASIT_Patchs *pQ, 
2564     PAF_ASIT_Config *pAsitCfg
2567     PAF_AST_Config *pAstCfg;
2568     Int as;                 /* Audio Stream Number (1, 2, etc.) */
2569     Int z;                  /* decode counter */
2570     Int zS;
2571     Int8 tempVar8;
2573     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
2574     as = pAstCfg->as;
2576     for (z=DECODE1; z < DECODEN; z++) 
2577     {
2578         zS = pP->streamsFromDecodes[z];
2579         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.command2), 
2580                                      GATEMP_INDEX_DEC);
2581         if (!(tempVar8 & 0x80))
2582         {
2583             switch (tempVar8)
2584             {
2585                 case 0: // command none - process
2586                     tempVar8 |= 0x80;
2587                     sharedMemWriteInt8(&(pAstCfg->xDec[z].decodeStatus.command2),
2588                                        tempVar8, GATEMP_INDEX_DEC);
2589                     break;
2590                 case 1: // command abort - leave now
2591                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command abort (0x%02x)", as+zS, 1);
2592                     tempVar8 |= 0x80;
2593                     sharedMemWriteInt8(&(pAstCfg->xDec[z].decodeStatus.command2),
2594                                        tempVar8, GATEMP_INDEX_DEC);
2595                     return (ASPERR_ABORT);
2596                 case 2: // command restart - leave later
2597                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command quit (0x%02x)", as+zS, 2);
2598                     tempVar8 |= 0x80;
2599                     sharedMemWriteInt8(&(pAstCfg->xDec[z].decodeStatus.command2),
2600                                        tempVar8, GATEMP_INDEX_DEC);
2601                                        
2602                     // Invoke command to output task to break the loop
2603                     gCommandOutputTask_SYNC = 1;
2604                     
2605                     return (ASPERR_QUIT);
2606                 default: // command unknown - ignore
2607                     break;
2608             }
2609         }
2610     }
2612     return 0;
2613 } //PAF_ASIT_decodeCommand
2615 // -----------------------------------------------------------------------------
2616 // ASIT Decoding Function - Reinitialization of Decode
2617 //
2618 //   Name:      PAF_ASIT_decodeInit
2619 //   Purpose:   Decoding Function for reinitializing the decoding process.
2620 //   From:      AST Parameter Function -> decodeProcessing
2621 //   Uses:      See code.
2622 //   States:    x
2623 //   Return:    Error number in standard or SIO form (0 on success).
2624 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2625 //              * State information as per parent.
2626 //
2627 Int
2628 PAF_ASIT_decodeInit(
2629     const PAF_ASIT_Params *pP, 
2630     const PAF_ASIT_Patchs *pQ, 
2631     PAF_ASIT_Config *pAsitCfg, 
2632     Int sourceSelect
2635     PAF_AST_Config *pAstCfg;
2636     //PAF_AST_DecOpCircBufCtl *pCbCtl;    /* Decoder output circular buffer control */
2637     AspMsgMaster_Handle hAspMsgMaster;
2638     Int as;                             /* Audio Stream Number (1, 2, etc.) */
2639     Int z;                              /* decode/encode counter */
2640     Int errno;                          /* error number */
2641     Int zI, zS;
2642     Int zMD;
2643     Int zMI;
2644     Int argIdx;
2645     Int8 tempVar8;
2646     char decMsgBuf[ASP_MSG_BUF_LEN];
2647     Int status;
2648     
2649     pAstCfg = pAsitCfg->pAstCfg;                // get pointer to AST common (shared) configuration
2650     hAspMsgMaster = pAsitCfg->hAspMsgMaster;    // get message master handle
2651     as = pAstCfg->as;
2652     zMD = pAstCfg->masterDec;
2653     zMI = pP->zone.master;
2654     (void)as;  // clear compiler warning in case not used with tracing disabled
2655     
2656     //pCbCtl = &pAsitCfg->pAspmCfg->decOpCircBufCtl; // get pointer to circular buffer control
2658     // reset frameCount
2659     for (z=DECODE1; z < DECODEN; z++)
2660     {
2661         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.mode),
2662                                      GATEMP_INDEX_DEC);
2663         if (tempVar8)
2664         {
2665             sharedMemWriteInt(&(pAstCfg->xDec[z].decodeStatus.frameCount),
2666                               (Int)0, GATEMP_INDEX_DEC);
2667         }
2668     }
2670     for (z=DECODE1; z < DECODEN; z++) 
2671     {
2672         zI = pP->inputsFromDecodes[z];
2673         zS = pP->streamsFromDecodes[z];
2674         (void)zS; // clear compiler warning in case not used with tracing disabled
2675         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.mode), 
2676                                      GATEMP_INDEX_DEC);
2677         if (pAstCfg->xInp[zI].hRxSio && tempVar8)
2678         {
2680             Uns gear;
2681             Int frameLength;
2682             TRACE_VERBOSE1("AS%d: PAF_ASIT_decodeInit: initializing decode", as+zS);
2684             // write back Dec configuration
2685             Cache_wb(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2686             Cache_wait();
2688             // send dec activate message to slave
2689             argIdx = 0; // set decIdx (zone index)
2690             *(Int32 *)&decMsgBuf[argIdx] = z;
2691             status = AspMsgSnd(hAspMsgMaster, ASP_SLAVE_DEC_ACTIVATE, decMsgBuf);
2692             if (status != ASP_MSG_NO_ERR)
2693             {
2694                 TRACE_TERSE0("decodeInit: error in sending DEC_ACTIVATE message");
2695                 SW_BREAKPOINT; // temporary
2696                 return -1; // temporary
2697             }           
2698             status = AspMsgRcvAck(hAspMsgMaster, ASP_MASTER_DEC_ACTIVATE_DONE, NULL, TRUE);
2699             if (status != ASP_MSG_NO_ERR)
2700             {
2701                 TRACE_TERSE0("decodeInit: error in receiving DEC_ACTIVATE_DONE message");
2702                 SW_BREAKPOINT; // temporary
2703                 return -1; // temporary
2704             }           
2706             // send dec reset message to slave
2707             argIdx = 0; // set decIdx
2708             *(Int32 *)&decMsgBuf[argIdx] = z;
2709             status = AspMsgSnd(hAspMsgMaster, ASP_SLAVE_DEC_RESET, decMsgBuf);
2710             if (status != ASP_MSG_NO_ERR)
2711             {
2712                 TRACE_TERSE0("decodeInit: error in sending DEC_RESET message ");
2713                 SW_BREAKPOINT; // temporary
2714                 return -1; // temporary
2715             }
2716             status = AspMsgRcvAck(hAspMsgMaster, ASP_MASTER_DEC_RESET_DONE, decMsgBuf, TRUE);
2717             if (status != ASP_MSG_NO_ERR)
2718             {
2719                 TRACE_TERSE0("decodeInit: error in receiving DEC_RESET_DONE ack message ");
2720                 SW_BREAKPOINT; // temporary
2721                 return -1; // temporary
2722             }
2723             else
2724             {
2725                 argIdx = 0; // get decErrno
2726                 errno = *(Int32 *)&decMsgBuf[argIdx];                
2727             }
2729             // invalidate Dec configuration
2730             Cache_inv(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2731             Cache_wait();
2732             
2733             if (errno != 0)
2734             {
2735                 return errno;
2736             }
2737             
2738             gear = (Uns)sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.aspGearControl),
2739                                               GATEMP_INDEX_DEC);
2740             tempVar8 = gear < GEARS ? gear : 0;
2741             sharedMemWriteInt8(&(pAstCfg->xDec[z].decodeStatus.aspGearStatus),
2742                                    tempVar8, GATEMP_INDEX_DEC);
2743             
2744             // Compute decoder frame length based on source selection
2745             frameLength = getFrameLengthSourceSel(pP, sourceSelect);
2746             
2747             pAstCfg->xDec[z].decodeControl.frameLength = frameLength;
2748             pAstCfg->xDec[z].decodeInStruct.sampleCount = frameLength;
2749             pAstCfg->xDec[z].decodeControl.sampleRate = PAF_SAMPLERATE_UNKNOWN;
2750           
2751             if (z != zMD) 
2752             {
2753                 if (errno = SIO_idle(pAstCfg->xInp[zI].hRxSio))
2754                 {
2755                     return errno;
2756                 }
2757             }
2759             tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.sourceSelect),
2760                                              GATEMP_INDEX_DEC);
2761             if (errno = SIO_ctrl(pAstCfg->xInp[zI].hRxSio, PAF_SIO_CONTROL_SET_SOURCESELECT,
2762                 DECSIOMAP(tempVar8)))
2763             {
2764                 return errno;
2765             }
2767             if (errno = SIO_ctrl(pAstCfg->xInp[zI].hRxSio, PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, 
2768                 frameLength))
2769             {
2770                 return errno;
2771             }
2772             if (errno = pP->fxns->updateInputStatus(pAstCfg->xInp[zI].hRxSio, &pAstCfg->xInp[zI].inpBufStatus, 
2773                 &pAstCfg->xInp[zI].inpBufConfig))
2774             {
2775                 return errno;
2776             }
2777         }
2778     }
2780     if (pAstCfg->xInp[zMI].hRxSio) 
2781     {
2782         errno = SIO_issue(pAstCfg->xInp[zMI].hRxSio, &pAstCfg->xInp[zMI].inpBufConfig,
2783             sizeof(pAstCfg->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME);
2784         if (errno)
2785         {
2786             return errno;
2787         }
2788     }
2790     return 0;
2791 } //PAF_AST_decodeInit
2793 // -----------------------------------------------------------------------------
2794 // ASIT Decoding Function - Info Processing, Common
2795 //
2796 //   Name:      PAF_ASIT_decodeInfo
2797 //   Purpose:   Decoding Function for processing information in a manner that
2798 //              is common for both initial and subsequent frames of input data.
2799 //   From:      AST Parameter Function -> decodeProcessing
2800 //   Uses:      See code.
2801 //   States:    x
2802 //   Return:    Error number in standard form (0 on success).
2803 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2804 //              * State information as per parent.
2805 //
2806 Int
2807 PAF_ASIT_decodeInfo(
2808     const PAF_ASIT_Params *pP, 
2809     const PAF_ASIT_Patchs *pQ, 
2810     PAF_ASIT_Config *pAsitCfg, 
2811     Int frame, 
2812     Int block
2815     PAF_AST_Config *pAstCfg;
2816     AspMsgMaster_Handle hAspMsgMaster;
2817     Int as;                    /* Audio Stream Number (1, 2, etc.) */
2818     Int z;                     /* input/decode/stream counter */
2819     Int errno;                 /* error number */
2820     Int sioErr;                /* error number, SIO */
2821     Int zD, zI, zS, zX;
2822     Int zMD;
2823     Int zMI;
2824     Int zMS;
2825     Int argIdx;
2826     Int8 tempVar8;
2827     Int tempVar;
2828     char decMsgBuf[ASP_MSG_BUF_LEN];
2829     Int status;
2831     
2832     pAstCfg = pAsitCfg->pAstCfg;                // get pointer to AST common (shared) configuration
2833     hAspMsgMaster = pAsitCfg->hAspMsgMaster;    // get message master handle
2834     as = pAstCfg->as;
2835     zMD = pAstCfg->masterDec;
2836     zMS = pAstCfg->masterStr;
2837     zMI = pP->zone.master;
2838     (void)zMS;  (void)as;  // clear compiler warning in case not used with tracing disabled
2839     
2840     // Set decode control: sample rate, emphasis
2841     for (z=INPUT1; z < INPUTN; z++)
2842     {
2843         zD = z;
2844         for (zX = DECODE1; zX < DECODEN; zX++) 
2845         {
2846             if (pP->inputsFromDecodes[zX] == z) 
2847             {
2848                 zD = zX;
2849                 break;
2850             }
2851         }
2852 #ifdef PROFILER
2853             // modify for different sampling rate
2854             if (pAstCfg->xInp[z].inpBufStatus.sampleRateStatus == PAF_SAMPLERATE_96000HZ)
2855             {
2856                 start_profiling = 1;
2857             }
2858             else
2859             {
2860                 start_profiling = 0;
2861             }
2862 #endif
2863         if (pAstCfg->xInp[z].hRxSio) 
2864         {
2865             //determine associated decoder
2866             if (pAstCfg->xInp[z].inpBufStatus.sampleRateStatus != 
2867                 pAstCfg->xDec[zD].decodeControl.sampleRate) 
2868             {
2869                 if (pAstCfg->xDec[zD].decodeControl.sampleRate == PAF_SAMPLERATE_UNKNOWN) 
2870                 {
2871                     pAstCfg->xDec[zD].decodeControl.sampleRate = 
2872                         pAstCfg->xInp[z].inpBufStatus.sampleRateStatus;
2873                 }
2874                 else
2875                 {
2876                     //TRACE_TERSE1("PAF_ASIT_decodeInfo: AS%d: return error ASPERR_INFO_RATECHANGE", as+pAstCfg->masterStr);
2877                     TRACE_TERSE2("inpBufStatus.sampleRateStatus: 0x%x, decodeControl.sampleRate: 0x%x",
2878                         pAstCfg->xInp[z].inpBufStatus.sampleRateStatus, 
2879                         pAstCfg->xDec[zD].decodeControl.sampleRate);
2880                     // return (ASPERR_INFO_RATECHANGE);
2881                 }
2882             }
2884             tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zD].decodeStatus.sourceDecode),
2885                                              GATEMP_INDEX_DEC);
2886             pAstCfg->xDec[zD].decodeControl.emphasis = 
2887                 tempVar8 != PAF_SOURCE_PCM
2888                 ? PAF_IEC_PREEMPHASIS_NO // fix for Mantis ID #119
2889                 : pAstCfg->xInp[z].inpBufStatus.emphasisStatus;
2890         }
2891         else 
2892         {
2893             pAstCfg->xDec[zD].decodeControl.sampleRate = PAF_SAMPLERATE_UNKNOWN;
2894             pAstCfg->xDec[zD].decodeControl.emphasis = PAF_IEC_PREEMPHASIS_UNKNOWN;
2895         }
2896     }
2898     // Wait for info input
2899     TRACE_VERBOSE2("PAF_ASIT_decodeInfo: AS%d: awaiting frame %d -- sync+info+data", as+zMS, frame);
2900     if (pAstCfg->xInp[zMI].hRxSio) 
2901     {
2902         TRACE_VERBOSE0("PAF_ASIT_decodeInfo: call SIO_reclaim to get input buffer.");
2903         sioErr = SIO_reclaim(pAstCfg->xInp[zMI].hRxSio, (Ptr)&pAstCfg->xInp[zMI].pInpBuf, NULL);
2904         if (sioErr != sizeof(pAstCfg->xInp[zMI].inpBufConfig))
2905         {
2906             TRACE_TERSE1("SIO_reclaim on input returned error ASPERR_RECLAIM.  sioErr: 0x%x", sioErr);
2907             return ASPERR_RECLAIM;
2908         }
2909         
2910 #if 0 // debug
2911         // capture input buffer
2912         capIb(pAstCfg->xInp[zMI].pInpBuf);
2913         gCapIb_cnt++;
2914 #endif
2915         
2916 #if 0 // debug
2917         // Shows timing of Input Rx SIO reclaim after decoding has started (autodet complete)
2918         // ADC B5
2919         {
2920             static Uint8 toggleState = 0;
2921             if (toggleState == 0)
2922                 GPIOSetOutput(GPIO_PORT_0, GPIO_PIN_99);
2923             else
2924                 GPIOClearOutput(GPIO_PORT_0, GPIO_PIN_99);
2925             toggleState = ~(toggleState);
2926         }
2927 #endif
2929         gAsipRxSioReclaimCnt++;
2930     } //pAstCfg->xInp[zMI].hRxSio
2932     // Decode info
2933     for (z=DECODE1; z < DECODEN; z++) 
2934     {
2935         zI = pP->inputsFromDecodes[z];
2936         zS = pP->streamsFromDecodes[z];
2937         (void)zS; // clear compiler warning in case not used with tracing disabled
2939         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.mode),
2940                                      GATEMP_INDEX_DEC);
2941         if (pAstCfg->xInp[zI].hRxSio && tempVar8)
2942         {
2943             TRACE_GEN2("PAF_ASIT_decodeInfo: AS%d: processing frame %d -- info", as+zS, frame);