142e7eca885f137e22696b556961ea72e2fb7454
[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 "common.h"
60 #include "paf_heapMgr.h"
61 #include "aspMsg_common.h"
62 #include "aspMsg_master.h"
63 #include "aspDecOpCircBuf_master.h"
64 #include "audioStreamProc_common.h"
65 #include "audioStreamProc_master.h"
66 #include "audioStreamInpProc.h"
67 #include "statusOp_common.h"
69 #include "pfp/pfp.h"
70 #include "pfp_app.h"        /* contains all PFP ID's */
72 // FL: debug
73 #include "dbgCapAf.h"
76 // -----------------------------------------------------------------------------
77 // Debugging Trace Control, local to this file.
78 // 
79 #include "logp.h"
81 #define TRACE_ARC(a)
83 // allows you to set a different trace module in pa.cfg
84 #define TR_MOD  trace
86 // Allow a developer to selectively enable tracing.
87 #define CURRENT_TRACE_MASK      0x21
89 #define TRACE_MASK_TERSE        0x01   // only flag errors and show init
90 #define TRACE_MASK_GENERAL      0x02   // half dozen lines per frame
91 #define TRACE_MASK_VERBOSE      0x04   // trace full operation
92 #define TRACE_MASK_DATA         0x08   // Show data
93 #define TRACE_MASK_TIME         0x10   // Timing related traces
94 #define TRACE_MASK_MSG          0x20   // Message related traces
96 #if !(CURRENT_TRACE_MASK & TRACE_MASK_TERSE)
97     #undef  TRACE_TERSE0
98     #undef  TRACE_TERSE1
99     #undef  TRACE_TERSE2
100     #undef  TRACE_TERSE3
101     #undef  TRACE_TERSE4
102     #define TRACE_TERSE0(a)
103     #define TRACE_TERSE1(a,b)
104     #define TRACE_TERSE2(a,b,c)
105     #define TRACE_TERSE3(a,b,c,d)
106     #define TRACE_TERSE4(a,b,c,d,e)
107 #endif
109 #if !(CURRENT_TRACE_MASK & TRACE_MASK_GENERAL)
110     #undef  TRACE_GEN0
111     #undef  TRACE_GEN1
112     #undef  TRACE_GEN2
113     #undef  TRACE_GEN3
114     #undef  TRACE_GEN4
115     #define TRACE_GEN0(a)
116     #define TRACE_GEN1(a,b)
117     #define TRACE_GEN2(a,b,c)
118     #define TRACE_GEN3(a,b,c,d)
119     #define TRACE_GEN4(a,b,c,d,e)
120 #endif
122 #if (CURRENT_TRACE_MASK & TRACE_MASK_VERBOSE)
123     // consolidate list of processing strings, indexed by PAF_SOURCE
124     static char *procName[] =
125     {
126         "", //PAF_SOURCE_UNKNOWN
127         "", //PAF_SOURCE_NONE
128         "AS%d: Pass processing ...",   //PAF_SOURCE_PASS
129         "AS%d: SNG processing ...",    //PAF_SOURCE_SNG
130         "AS%d: Auto processing ...",   //PAF_SOURCE_AUTO
131         "AS%d: Auto processing ...",   //PAF_SOURCE_BITSTREAM
132         "AS%d: DTS processing ...",    //PAF_SOURCE_DTSALL
133         "AS%d: PCM processing ...",    //PAF_SOURCE_PCMAUTO
134         "AS%d: PCM processing ...",    //PAF_SOURCE_PCM
135         "AS%d: PCN processing ...",    //PAF_SOURCE_PC8
136         "AS%d: AC3 processing ...",    //PAF_SOURCE_AC3
137         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS
138         "AS%d: AAC processing ...",    //PAF_SOURCE_AAC
139         "AS%d: MPG processing ...",    //PAF_SOURCE_MPEG
140         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS12
141         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS13
142         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS14
143         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS16
144         "AS%d: WMP processing ...",    //PAF_SOURCE_WMA9PRO
145         "AS%d: MP3 processing ...",    //PAF_SOURCE_MP3
146         "AS%d: DSD processing ...",    //PAF_SOURCE_DSD1
147         "AS%d: DSD processing ...",    //PAF_SOURCE_DSD2
148         "AS%d: DSD processing ...",    //PAF_SOURCE_DSD3
149         "AS%d: DDP processing ...",    //PAF_SOURCE_DDP
150         "AS%d: DTSHD processing ...",  //PAF_SOURCE_DTSHD
151         "AS%d: THD processing ...",    //PAF_SOURCE_THD
152         "AS%d: DXP processing ...",    //PAF_SOURCE_DXP
153         "AS%d: WMA processing ...",    //PAF_SOURCE_WMA
154     };
156 #else
157     #undef  TRACE_VERBOSE0
158     #undef  TRACE_VERBOSE1
159     #undef  TRACE_VERBOSE2
160     #undef  TRACE_VERBOSE3
161     #undef  TRACE_VERBOSE4
162     #define TRACE_VERBOSE0(a)
163     #define TRACE_VERBOSE1(a,b)
164     #define TRACE_VERBOSE2(a,b,c)
165     #define TRACE_VERBOSE3(a,b,c,d)
166     #define TRACE_VERBOSE4(a,b,c,d,e)
167 #endif
169 #if (CURRENT_TRACE_MASK & TRACE_MASK_DATA)
170     #define TRACE_DATA(a) LOG_printf a
171 #else
172     #define TRACE_DATA(a)
173 #endif
175 #if (CURRENT_TRACE_MASK & TRACE_MASK_TIME)
176     #define TRACE_TIME(a) LOG_printf a
177     #define TIME_MOD  trace // this could be different
178     static Int dtime()
179     {
180          static Int old_time = 0;
181          Int time = TSK_time();
182          Int delta_time = time - old_time;
183          old_time = time;
184          return( delta_time);
185     }
187     static char *stateName[11] =
188     {
189          "INIT",
190          "INFO1",
191          "AGAIN",
192          "INFO2",
193          "CONT",
194          "TIME",
195          "DECODE",
196          "STREAM",
197          "ENCODE",
198          "FINAL",
199          "QUIT"
200     };
202 #else
203     #define TRACE_TIME(a)
204 #endif
206 #if !(CURRENT_TRACE_MASK & TRACE_MASK_MSG)
207     #undef  TRACE_MSG0
208     #undef  TRACE_MSG1
209     #undef  TRACE_MSG2
210     #undef  TRACE_MSG3
211     #undef  TRACE_MSG4
212     #define TRACE_MSG0(a)
213     #define TRACE_MSG1(a,b)
214     #define TRACE_MSG2(a,b,c)
215     #define TRACE_MSG3(a,b,c,d)
216     #define TRACE_MSG4(a,b,c,d,e)
217 #endif
218     
220 // .............................................................................
222 #include <pafsio.h>
223 #include "paferr.h"
225 #include <acp_mds.h>
227 #include <pcm.h>
229 #include <pce.h>
231 #include <doberr.h>
233 #include <diberr.h>
235 #include <stdasp.h>
237 #include "as0.h"
238 #include "asperr.h"
240 #include "audioStreamProc_params.h"
241 #include "audioStreamProc_patchs.h"
242 #include "audioStreamProc_config.h"
243 #include "audioStreamInpProc.h"
246 #include "dbgBenchmark.h" // PCM high-sampling rate + SRC + CAR benchmarking
247 #ifdef _ENABLE_BENCHMARK_PCMHSR_SRC_CAR_
248 //
249 // Performing PCM high-sampling rate + SRC + CAR benchmarking
250 //
252 #define PROFILER
253 #endif
255 #ifdef PROFILER
256 extern UInt32 start_profiling;
257 #endif
259 extern UInt32 gAspProfileEnable;
261 //
262 // Audio Stream Definitions
263 //
265 // minimum audio frame "length" in samples (must be multiple of PA_MODULO)
266 #define MINFRAMELENGTH 24
267 #define PA_MODULO       8   // also defined independently in ARC2 code, and may be hard coded other places.
270 //
271 // Decoder Definitions
272 //
273 //#define decLinkInit pQ->i_decLinkInit
275 //
276 // Audio Stream Processing Definitions
277 //
278 //#define aspLinkInit pQ->i_aspLinkInit
280 //
281 // Encoder Definitions
282 //
283 #define encLinkInit pQ->i_encLinkInit
285 //
286 // Input, Output Definitions
287 //
288 #define inpLinkInit pP->i_inpLinkInit
289 //#define outLinkInit pP->i_outLinkInit
291 /* ---------------------------------------------------------------- */
292 /*              Parameter macro definitions end here.               */
293 /* ---------------------------------------------------------------- */
295 //
296 // Standardized Definitions
297 //
299 //#define DEC_Handle PCM_Handle /* works for all: SNG, PCM, AC3, DTS, AAC */
300 //#define ENC_Handle PCE_Handle /* works for all: PCE */
302 #define __TASK_NAME__  "TaskAsip"
304 LINNO_DEFN(TaskAsip); /* Line number macros */
305 ERRNO_DEFN(TaskAsip); /* Error number macros */
307 // ASIT configuration
308 #pragma DATA_SECTION(gPAF_ASIT_config, ".globalSectionPafAsitConfig")
309 PAF_ASIT_Config gPAF_ASIT_config = {
310     NULL,               // taskHandle
311     NULL,               // acp
312     &gPAF_ASPM_config,  // pAspmCfg, shared ASIT/ASOT configuration
313     &gPAF_AST_config    // pAstCfg, shared ASIT/ASOT/ASDT configuration
314 };
316 // Global debug counters */
317 UInt32 gTaskAsipCnt             =0;
318 UInt32 gAsipInitCnt             =0;
319 UInt32 gAsipInfo1Cnt            =0;
320 UInt32 gAsipInfo2Cnt            =0;
321 UInt32 gAsipDecodeCnt           =0;
322 UInt32 gAsipDecodeErrCnt        =0;
323 UInt32 gAsipFinalCnt            =0;
324 UInt32 gAsipQuitCnt             =0;
325 UInt32 gAsipInfo1_PrimaryErrCnt =0;
326 UInt32 gAsipInfo1_ErrCnt        =0;
327 UInt32 gAsipInfo2_PrimaryErrCnt =0;
328 UInt32 gAsipInfo2_ErrCnt        =0;
329 UInt32 gCapIbReset_cnt          =0;
330 UInt32 gCapIb_cnt               =0;
331 // debug
332 UInt32 gCbWrtAfErrCnt           =0; // decoder output circular buffer write error count (returned from ARM to DSP)
333                                    
335 #include "dbgDib.h" // debug
337 extern struct {
338     Int size;
339     IALG_Status *pStatus[512];
340 } IACP_STD_BETA_TABLE;
342 // FL: debug
343 #include "evmc66x_gpio_dbg.h"
345 /*
346  *  ======== taskAsipFxn ========
347  *  Audio Stream Input Processing task function
348  */
349 Void taskAsipFxn(
350 //    Int betaPrimeValue, // FL: revisit
351     const PAF_ASIT_Params *pP,
352     const PAF_ASIT_Patchs *pQ
355     PAF_ASIT_Config *pC;            /* Local configuration pointer */
356     PAF_AST_Config *pAstCfg;        /* Common (shared) configuration pointer */
357     Int as;                         /* Audio Stream Number (1, 2, etc.) */
358     Int z;                          /* input/encode/stream/decode/output counter */
359     Int i;                          /* phase */
360     Int errno;                      /* error number */
361     Int zMD, zMI, zMS, zX;
362     Int loopCount = 0;  // used to stop trace to see startup behavior.        
363     UInt32 curTime;
364     Int size;
365     // Messaging
366     ASP_Msg *pAspMsg;              
367     Int status;
368 #ifdef NON_CACHE_STATUS
369     Int8 tempVar8;
370 #endif
372     Log_info0("Enter taskAsipFxn()");
374     //
375     // Audio Framework Parameters & Patch (*pP, *pQ)
376     //
377     if (!pP) 
378     {
379         TRACE_TERSE0("TaskAsip: No Parameters defined. Exiting.");
380         LINNO_RPRT(TaskAsip, -1);
381         return;
382     }
384     if (!pQ)
385     {
386         TRACE_TERSE0("TaskAsip: No Patchs defined. Exiting.");
387         LINNO_RPRT(TaskAsip, -1);
388         return;
389     }    
390     
391     //
392     // Audio Framework Configuration (*pC):
393     //
394     pC = &gPAF_ASIT_config;         // initialize pointer to task configuration
395     pC->taskHandle = Task_self();   // set task handle
396     pAstCfg = pC->pAstCfg;          // get pointer to common (shared) configuration
398     /* Set Audio Stream Number (1, 2, etc.) */
399     as = gBetaPrimeValue + 1;
400     pAstCfg->as = as;    
401     TRACE_TERSE1("TaskAsip: Started with AS%d.", as);
403     //
404     // Initialize message log trace and line number reporting
405     //
406     for (z=STREAM1; z < STREAMN; z++)
407     {
408         TRACE_TERSE1("TaskAsip: AS%d: initiated", as+z);
409     }
410     LINNO_RPRT(TaskAsip, -1);
411     
412     //
413     // Determine decoder and stream indices associated with the master input
414     //
415     zMI = pP->zone.master;
416     pAstCfg->masterDec = zMI;
417     pAstCfg->masterStr = zMI;
418     for (zX = DECODE1; zX < DECODEN; zX++)
419     {
420         if (pP->inputsFromDecodes[zX] == zMI)
421         {
422             pAstCfg->masterDec = zX;
423             pAstCfg->masterStr = pP->streamsFromDecodes[zX];
424             break;
425         }
426     }
427     zMD = pAstCfg->masterDec;
428     zMS = pAstCfg->masterStr;
430     // Initialize as per parametrized phases:
431     //
432     //   In standard form these are:
433     //      - Malloc: Memory Allocation
434     //      - Config: Configuration Initialization
435     //      - AcpAlg: ACP Algorithm Initialization and Local Attachment
436     //      - Common: Common Memory Initialization
437     //      - AlgKey: Dec/Enc chain to Array Initialization
438     //      - Device: I/O Device Initialization
439     //      - DecOpCircBuf: Decoder Output Circular Buffer
440     //      - Unused: (available)
441     //
442     LINNO_RPRT(TaskAsip, -2);
443     for (i=0; i < lengthof(pP->fxns->initPhase); i++)
444     {
445         Int linno;
446         if (pP->fxns->initPhase[i])
447         {
448             if (linno = pP->fxns->initPhase[i](pP, pQ, pC)) 
449             {
450                 LINNO_RPRT(TaskAsip, linno);
451                 return;
452             }
453         }
454         else 
455         {
456             TRACE_TERSE1("TaskAsip: AS%d: initialization phase - null", as+zMS);
457         }
458         TRACE_TERSE2("TaskAsip: AS%d: initialization phase - %d completed", as+zMS, i);
459         LINNO_RPRT(TaskAsip, -i-3);
460     }
462     //
463     // End of Initialization -- display memory usage report.
464     //
465     if (pP->fxns->memStatusPrint)
466     {
467         pP->fxns->memStatusPrint(HEAP_INTERNAL, HEAP_INTERNAL1, HEAP_EXTERNAL, HEAP_INTERNAL1_SHM);
468     }
469     
470     // (***) FL: revisit
471     // write back AST shared configuration
472     Cache_wb(pAstCfg, sizeof(PAF_AST_Config), Cache_Type_ALLD, 0);
473     // FL: no need to share this pointer, can be local
474     //Cache_wb(&pC, sizeof(PAF_AST_Config *), Cache_Type_ALLD, 0);
475     Cache_wait();
477     // (***) FL: revisit
478     // write back Dec configuration
479     Cache_wb(&pAstCfg->xDec[0], DECODEN*sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
480     Cache_wait();
482     // (***) FL: revisit
483     // write back entire beta table
484     Cache_wb((Ptr)(&IACP_STD_BETA_TABLE.pStatus[0]), 512*sizeof(IALG_Status *), Cache_Type_ALLD, 0);
485     Cache_wait();
486     
487     // FL: send start initialization message to slave
488     pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize); /* allocate message */
489     MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
490     pAspMsg->cmd = ASP_SLAVE_START;                                                     /* fill in message payload */
491     pAspMsg->procId = hAspMsgMaster->masterProcId;
492     pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
493     pAspMsg->expectResp = TRUE;
494     TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
495     status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message */
496     if (status != MessageQ_S_SUCCESS)
497     {
498         SW_BREAKPOINT;
499     }
500     // wait for initialization complete message from slave
501     do {
502         //status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
503         status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, 0); // FL: no other thread is allowed to run until Slave finished startup
504     } while ((status != MessageQ_S_SUCCESS) || (pAspMsg->cmd != ASP_MASTER_START_DONE));
505     if ((pAspMsg->procId != hAspMsgMaster->slaveProcId) ||
506         (pAspMsg->cmd != ASP_MASTER_START_DONE) || 
507         (pAspMsg->messageId != (hAspMsgMaster->messageId | ((UInt32)1<<31))))
508     {
509         TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
510         SW_BREAKPOINT;
511     }
512     hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
513     TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
514     status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
515     if (status != MessageQ_S_SUCCESS)
516     {
517         SW_BREAKPOINT;
518     }
520     // (***) FL: revisit
521     // invalidate Status structure addresses for Beta Units initialized on Slave
522     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
523     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
524     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
525     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
526     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
527     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
528     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
529     Cache_wait();
530     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]) Log_info0("ERROR: beta unit for Dec==NULL");
531     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]) Log_info0("ERROR: beta unit for Dec==NULL");
532     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]) Log_info0("ERROR: beta unit for Dec==NULL");
533     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]) Log_info0("ERROR: beta unit for Dec==NULL");
534     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]) Log_info0("ERROR: beta unit for Dec==NULL");
535     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]) Log_info0("ERROR: beta unit for Dec==NULL");
536     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]) Log_info0("ERROR: beta unit for Dec==NULL");
537     
538     // (***) FL: revisit
539     // invalidate Status structures for Beta Units initialized on Slave
540     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), sizeof(Int), Cache_Type_ALLD, 0);
541     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]->size;
542     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), size, Cache_Type_ALLD, 0);
543     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), sizeof(Int), Cache_Type_ALLD, 0);
544     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]->size;
545     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), size, Cache_Type_ALLD, 0);
546     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]), sizeof(Int), Cache_Type_ALLD, 0);
547     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]->size;
548     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]), size, Cache_Type_ALLD, 0);
549     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), sizeof(Int), Cache_Type_ALLD, 0);
550     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]->size;
551     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), size, Cache_Type_ALLD, 0);
552     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]), sizeof(Int), Cache_Type_ALLD, 0);
553     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]->size;
554     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]), size, Cache_Type_ALLD, 0);
555     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]), sizeof(Int), Cache_Type_ALLD, 0);
556     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]->size;
557     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]), size, Cache_Type_ALLD, 0);
558     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]), sizeof(Int), Cache_Type_ALLD, 0);
559     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]->size;
560     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]), size, Cache_Type_ALLD, 0);
561     Cache_wait();
562     
563 #ifdef NON_CACHE_STATUS
564     // Get the shared status structure GateMP handles. Initialized at slave.
565     if (statusOp_Init(GATEMP_INDEX_DEC) == STATUSOP_INIT_FAIL)
566     {
567         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_DEC);
568     }
569     if (statusOp_Init(GATEMP_INDEX_DDP) == STATUSOP_INIT_FAIL)
570     {
571         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_DDP);
572     }
573     if (statusOp_Init(GATEMP_INDEX_PCM) == STATUSOP_INIT_FAIL)
574     {
575         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_PCM);
576     }
577     if (statusOp_Init(GATEMP_INDEX_THD) == STATUSOP_INIT_FAIL)
578     {
579         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_THD);
580     }
581 #endif
583     // (***) FL: revisit
584     // invalidate Dec configuration
585     Cache_inv(&gPAF_AST_config.xDec[0], DECODEN*sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
586     Cache_wait();
587     
588     //
589     // Main processing loop
590     //   
591     for (z=STREAM1; z < STREAMN; z++)
592     {
593         TRACE_VERBOSE1("TaskAsip: AS%d: running", as+z);
594     }
596     TRACE_TERSE0("TaskAsip: Entering Main Loop.");
597     
598     errno = 0;
599     for (;;)
600     {
601         Int sourceSelect;
602         XDAS_Int8 sourceProgram;
604         loopCount++;
606 #if 0   // enable and tune to see startup behavior.
607         // this is an alternative to fixed/circular setting in pa.cfg.
608         // If you are searching for a memory allocation failure, disable on first round.
609         // All allocation has already happened.
610         // This is the outer loop.  This loop count goes up when the stream resets.
611         // If the stream is running without problems, this does not increment.
612         // If the stream is repeatedly resetting, this loop count will go up rapidly.
613         if (loopCount > 10)  // see traces for a few of the passes through the main loop.
614         {
615              TRACE_TERSE1("TaskAsip: Trace stopped at loop %d.", loopCount);
616              LOG_disable(&TR_MOD);  // stop tracing
617         }
618 #endif
620         TRACE_GEN2("TaskAsip (begin Main loop %d) (errno 0x%x)", loopCount, errno);
621         TRACE_TIME((&TIME_MOD, "as1_f2... + %d = %d (begin Main loop)", dtime(), TSK_time()));
622         
623         // since not decoding indicate such
624         pP->fxns->sourceDecode(pP, pQ, pC, PAF_SOURCE_NONE);
626         // any error forces idling of input
627         if (errno) 
628         {
629             for (z=INPUT1; z < INPUTN; z++)
630             {
631                 if (pAstCfg->xInp[z].hRxSio)
632                 {
633                     SIO_idle(pAstCfg->xInp[z].hRxSio);
634                 }
635             }
636         
637             TRACE_TERSE1("TaskAsip: Trace stopped at loop %d.", loopCount);
638             ERRNO_RPRT(TaskAsip, errno);
639         }
640         
641         // Execute a TSK_sleep to ensure that any non-blocking code paths are broken
642         // up to allow lower priority tasks to run. This may seem odd to be at the top
643         // of the state machine but provides for a cleaner flow even though the very
644         // first time we enter we do a sleep which is non-intuitive.
645         TRACE_VERBOSE1("TaskAsip: AS%d: ... sleeping ...", as+zMS);
646         TRACE_TIME((&TIME_MOD, "as1-f2... + %d = %d (begin SLEEP)", dtime(), TSK_time()));
647         Task_sleep(1);
649         TRACE_GEN1("TaskAsip: AS%d: Input device selection ...", as+zMS);
650         if (errno = pP->fxns->selectDevices(pP, pQ, pC))
651         {
652             TRACE_TERSE2("TaskAsip: selectDevices returned errno = 0x%04x at line %d. AS%d", errno, as+zMS);
653             continue;
654         }
656         // if no master input selected then we don't know what may be at the input
657         // so set to unknown and skip any remaining processing
658         if (!pAstCfg->xInp[zMI].hRxSio)
659         {
660 #ifdef NON_CACHE_STATUS
661             tempVar8 = PAF_SOURCE_UNKNOWN;
662             statusOp_write(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram),
663                            &tempVar8,
664                            sizeof(tempVar8),
665                            GATEMP_INDEX_DEC);
666 #else
667             pAstCfg->xDec[zMD].decodeStatus.sourceProgram = PAF_SOURCE_UNKNOWN;
668 #endif
669             TRACE_VERBOSE1("TaskAsip: AS%d: No input selected...", as+zMS);
670             continue;
671         }
672         
673         // if here then we have a valid input so query its status
674         if (errno = pP->fxns->updateInputStatus(pAstCfg->xInp[zMI].hRxSio, &pAstCfg->xInp[zMI].inpBufStatus, &pAstCfg->xInp[zMI].inpBufConfig))
675         {
676             TRACE_VERBOSE1("TaskAsip: continue as updateInputStatus returns 0x%x", errno);
677             continue;
678         }
679         
680 #ifdef NON_CACHE_STATUS
681         statusOp_read(&tempVar8,
682                       &(pAstCfg->xDec[zMD].decodeStatus.mode),
683                       sizeof(tempVar8),
684                       GATEMP_INDEX_DEC);
685         // If master decoder is not enabled, or the input is unlocked, then do nothing
686         if (!tempVar8 || !pAstCfg->xInp[zMI].inpBufStatus.lock)
687         {
688             TRACE_VERBOSE0("TaskAsip: Not locked, continue");
689             continue;
690         }
691 #else
692         // If master decoder is not enabled, or the input is unlocked, then do nothing
693         if (!pAstCfg->xDec[zMD].decodeStatus.mode || !pAstCfg->xInp[zMI].inpBufStatus.lock)
694         {
695             TRACE_VERBOSE0("TaskAsip: Not locked, continue");
696             continue;
697         }
698 #endif
699         
700 #ifdef NON_CACHE_STATUS
701         statusOp_read(&tempVar8,
702                       &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
703                       sizeof(tempVar8),
704                       GATEMP_INDEX_DEC);
705         // If no source selected then do nothing
706         if (tempVar8 == PAF_SOURCE_NONE)
707         {
708             tempVar8 = PAF_SOURCE_NONE;
709             statusOp_write(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram),
710                            &tempVar8,
711                            sizeof(tempVar8),
712                            GATEMP_INDEX_DEC);
713             TRACE_VERBOSE1("TaskAsip: AS%d: no source selected, continue", as+zMS);
714             continue;
715         }
716 #else
717         // If no source selected then do nothing
718         if (pAstCfg->xDec[zMD].decodeStatus.sourceSelect == PAF_SOURCE_NONE) 
719         {
720             pAstCfg->xDec[zMD].decodeStatus.sourceProgram = PAF_SOURCE_NONE;
721             TRACE_VERBOSE1("TaskAsip: AS%d: no source selected, continue", as+zMS);
722             continue;
723         }
724 #endif
726 #ifdef NON_CACHE_STATUS
727         statusOp_read(&tempVar8,
728                       &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
729                       sizeof(tempVar8),
730                       GATEMP_INDEX_DEC);
731         // If we want pass processing then proceed directly
732         if (tempVar8 == PAF_SOURCE_PASS)
733         {
734             TRACE_VERBOSE1("TaskAsip: AS%d: Pass processing ...", as+zMS);
736             tempVar8 = PAF_SOURCE_PASS;
737             statusOp_write(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram),
738                            &tempVar8,
739                            sizeof(tempVar8),
740                            GATEMP_INDEX_DEC);
741 #else
742         // If we want pass processing then proceed directly
743         if (pAstCfg->xDec[zMD].decodeStatus.sourceSelect == PAF_SOURCE_PASS) 
744         {
745             TRACE_VERBOSE1("TaskAsip: AS%d: Pass processing ...", as+zMS);
746             pAstCfg->xDec[zMD].decodeStatus.sourceProgram = PAF_SOURCE_PASS;
747 #endif
748             pP->fxns->sourceDecode(pP, pQ, pC, PAF_SOURCE_PASS);
749             if (pP->fxns->passProcessing)
750             {
751                 errno = pP->fxns->passProcessing(pP, pQ, pC, NULL);                
752             }
753             else 
754             {
755                 TRACE_TERSE2("TaskAsip: AS%d: Pass Processing not supported, errno 0x%x", as+zMS, ASPERR_PASS);
756                 errno = ASPERR_PASS;
757             }
758             TRACE_VERBOSE0("TaskAsip: continue");
759             continue;
760         }
762 #ifdef NON_CACHE_STATUS
763         statusOp_read(&tempVar8,
764                       &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
765                       sizeof(tempVar8),
766                       GATEMP_INDEX_DEC);
767         // .....................................................................
768         // At this point we have an enabled input and want to decode something.
769         // If no decoder selected then do nothing. Need to reset the sourceProgram, since
770         // when no decoder is selected there are no calls to IB
771         //if (errno = pP->fxns->autoProcessing(pP, pQ, pC, pC->xDec[zMD].decodeStatus.sourceSelect, pC->xDec[zMD].decAlg[PAF_SOURCE_PCM]))
772         if (errno = pP->fxns->autoProcessing(pP, pQ, pC, tempVar8, NULL)) // (***) FL: re-visit this, hard-coded to use PCM framelength inside function
773         {
774             TRACE_VERBOSE1("TaskAsip: autoProcessing returns 0x%x, continue", errno);
775             continue;
776         }
777 #else
778         // .....................................................................
779         // At this point we have an enabled input and want to decode something.
780         // If no decoder selected then do nothing. Need to reset the sourceProgram, since
781         // when no decoder is selected there are no calls to IB
782         //if (errno = pP->fxns->autoProcessing(pP, pQ, pC, pC->xDec[zMD].decodeStatus.sourceSelect, pC->xDec[zMD].decAlg[PAF_SOURCE_PCM]))
783         if (errno = pP->fxns->autoProcessing(pP, pQ, pC, pAstCfg->xDec[zMD].decodeStatus.sourceSelect, NULL)) // (***) FL: re-visit this, hard-coded to use PCM framelength inside function
784         {
785             TRACE_VERBOSE1("TaskAsip: autoProcessing returns 0x%x, continue", errno);
786             continue;
787         }
788 #endif
789         
790         // query for input type
791         if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_SOURCEPROGRAM, (Arg )&sourceProgram))
792         {
793             TRACE_TERSE2("TaskAsip: SIO_ctrl returns 0x%x, then 0x%x, continue", errno, ASPERR_AUTO_PROGRAM);
794             errno = ASPERR_AUTO_PROGRAM;
795             continue;
796         }
797 #ifdef NON_CACHE_STATUS
798         statusOp_write(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram),
799                       &(sourceProgram),
800                       sizeof(sourceProgram),
801                       GATEMP_INDEX_DEC);
802 #else
803         pAstCfg->xDec[zMD].decodeStatus.sourceProgram = sourceProgram;
804 #endif
806         // if input is unclassifiable then do nothing
807         if (sourceProgram == PAF_SOURCE_UNKNOWN)
808         {
809             TRACE_VERBOSE0("TaskAsip: Source program unknown. continue");
810             continue;
811         }
813         // now that we have some input classification, and possibly an outstanding
814         // input frame, we determine whether or not to call decodeProcessing and with
815         // what decAlg.
816         sourceSelect = PAF_SOURCE_NONE;
817 #ifdef NON_CACHE_STATUS
818         statusOp_read(&tempVar8,
819                       &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
820                       sizeof(tempVar8),
821                       GATEMP_INDEX_DEC);
822         switch (tempVar8)
823         {
824 #else
825         switch (pAstCfg->xDec[zMD].decodeStatus.sourceSelect) 
826         {
827 #endif
828             // If autodetecting, decoding everything, and input is something
829             // (i.e. bitstream or PCM) then decode.
830             case PAF_SOURCE_AUTO:
831                 if (sourceProgram >= PAF_SOURCE_PCM)
832                 {
833                     sourceSelect = sourceProgram;                    
834                 }
835                 break;
837             // If autodetecting, decoding only PCM, and input is PCM then decode.
838             case PAF_SOURCE_PCMAUTO:
839                 if (sourceProgram == PAF_SOURCE_PCM)
840                 {
841                     sourceSelect = sourceProgram;                    
842                 }
843                 break;
845             // If autodetecting, decoding only bitstreams, and input is a bitstream then decode.
846             case PAF_SOURCE_BITSTREAM:
847                 if (sourceProgram >= PAF_SOURCE_AC3)
848                 {
849                     sourceSelect = sourceProgram;                    
850                 }
851                 break;
853             // If autodetecting, decoding only DTS, and input is DTS then decode.
854             case PAF_SOURCE_DTSALL:
855                 switch (sourceProgram) 
856                 {
857                     case PAF_SOURCE_DTS11:
858                     case PAF_SOURCE_DTS12:
859                     case PAF_SOURCE_DTS13:
860                     case PAF_SOURCE_DTS14:
861                     case PAF_SOURCE_DTS16:
862                     case PAF_SOURCE_DTSHD:
863                         sourceSelect = sourceProgram;
864                         break;
865                 }
866                 break;
868             // All others, e.g., force modes, fall through to here.
869             // If user made specific selection then program must match select.
870             // (NB: this compare relies on ordering of PAF_SOURCE)
871             default:
872 #ifdef NON_CACHE_STATUS
873                 sourceSelect = 0; // due to size difference
874                 statusOp_read(&sourceSelect,
875                               &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
876                               sizeof(Int8),
877                               GATEMP_INDEX_DEC);
878 #else
879                 sourceSelect = pAstCfg->xDec[zMD].decodeStatus.sourceSelect;
880 #endif
881                 if ((sourceSelect >= PAF_SOURCE_PCM) && (sourceSelect <= PAF_SOURCE_N))
882                 {
883                     if (sourceProgram != sourceSelect)
884                     {
885                         sourceSelect = PAF_SOURCE_NONE;                        
886                     }
887                 }
888                 break;
889         }
891         // if we didn't find any matches then skip
892         if (sourceSelect == PAF_SOURCE_NONE)
893         {
894             TRACE_VERBOSE0("TaskAsip: no matching source type, continue");
895             continue;
896         }
898         // FL: debug, reset IB capture buffer
899         capIbReset();
900         gCapIbReset_cnt++;
901         Log_info0("capIbReset()");
903         // FL: send source select message to slave
904         pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize); /* allocate message */
905         MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
906         pAspMsg->cmd = ASP_SLAVE_DEC_SOURCE_SELECT;                                         /* fill in message payload */
907         pAspMsg->procId = hAspMsgMaster->masterProcId;
908         pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
909         pAspMsg->expectResp = TRUE;
910         *(Int32 *)&pAspMsg->buf[0] = sourceSelect;
911         TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
912         TRACE_MSG1("sourceSelect=%d", pAspMsg->buf[0]);
913         status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message */
914         if (status != MessageQ_S_SUCCESS)
915         {
916             SW_BREAKPOINT;
917         }
918         // wait for source select complete message from slave
919         //do {
920         //    status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
921         //} while (status != MessageQ_S_SUCCESS);
922         status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
923         if (status != MessageQ_S_SUCCESS)
924         {
925             TRACE_TERSE0("MessageQ_get() failure.");
926             SW_BREAKPOINT; // temporary
927         }
928         if ((pAspMsg->procId != hAspMsgMaster->slaveProcId) ||
929             (pAspMsg->cmd != ASP_MASTER_DEC_SOURCE_SELECT_DONE) ||
930             (pAspMsg->messageId != (hAspMsgMaster->messageId | ((UInt32)1<<31))))
931         {
932             TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
933             SW_BREAKPOINT;
934         }
935         hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
936         TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
937         status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
938         if (status != MessageQ_S_SUCCESS)
939         {
940             SW_BREAKPOINT;
941         }
942         
943         // set to unknown so that we can ensure, for IOS purposes, that sourceDecode = NONE
944         // iff we are in this top level state machine and specifically not in decodeProcessing
945         pP->fxns->sourceDecode(pP, pQ, pC, PAF_SOURCE_UNKNOWN);
946         
947         TRACE_VERBOSE1(procName[sourceProgram], as+zMS);
949         // Reduce priority level since autodetection complete
950         Task_setPri(pC->taskHandle, Task_getPri(pC->taskHandle)-1);
951         
952         gAspProfileEnable=1; // enable ASP profiling
953         
954         TRACE_VERBOSE0("TaskAsip: calling decodeProcessing.");
955         errno = pP->fxns->decodeProcessing(pP, pQ, pC, sourceSelect);
956         if (errno) 
957         {
958             TRACE_TERSE1("TaskAsip: decodeProcessing returns 0x%x, continue", errno);
959         }
960         else
961         {
962             TRACE_VERBOSE0("TaskAsip: decodeProcessing complete with no error.");
963         }        
965         gAspProfileEnable=0; // disable ASP profiling
966         
967         // Increase priority level since decoding complete
968         Task_setPri(pC->taskHandle, Task_getPri(pC->taskHandle)+1);
970         // FL: send dec exit message to slave
971         pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize); /* allocate message */
972         MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
973         pAspMsg->cmd = ASP_SLAVE_DEC_EXIT;                                                  /* fill in message payload */
974         pAspMsg->procId = hAspMsgMaster->masterProcId;
975         pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
976         pAspMsg->expectResp = TRUE;
977         TRACE_MSG2("Tx ASP message: procId=%d, cmd=%d.", pAspMsg->procId, pAspMsg->cmd);
978         status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message */
979         if (status != MessageQ_S_SUCCESS)
980         {
981             SW_BREAKPOINT;
982         }
983         // wait for dec exit complete message from slave
984         //do {
985         //    status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
986         //} while ((status < 0) || (pAspMsg->cmd != ASP_MASTER_DEC_EXIT_DONE));
987         status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
988         if (status != MessageQ_S_SUCCESS)
989         {
990             TRACE_TERSE0("MessageQ_get() failure.");
991             SW_BREAKPOINT; // temporary
992         }
993         if ((pAspMsg->procId != hAspMsgMaster->slaveProcId) || 
994             (pAspMsg->cmd != ASP_MASTER_DEC_EXIT_DONE) ||
995             (pAspMsg->messageId != (hAspMsgMaster->messageId | ((UInt32)1<<31))))
996         {
997             TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
998             SW_BREAKPOINT;
999         }
1000         hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
1001         TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
1002         // free the message
1003         status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
1004         if (status != MessageQ_S_SUCCESS)
1005         {
1006             SW_BREAKPOINT;
1007         }
1008     } // End of main processing loop for (;;)
1009     
1010     Log_info0("Exit taskAsipFxn()");
1013 // -----------------------------------------------------------------------------
1014 // ASIT Initialization Function - Memory Allocation
1015 //
1016 //   Name:      PAF_ASIT_initPhaseMalloc
1017 //   Purpose:   Audio Stream Input Task Function for initialization of data pointers
1018 //              by allocation of memory.
1019 //   From:      audioStream1Task or equivalent
1020 //   Uses:      See code.
1021 //   States:    x
1022 //   Return:    0 on success.
1023 //              Source code line number on MEM_calloc failure.
1024 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1025 //              * State information as per parent.
1026 //              * Memory allocation errors.
1027 //
1028 Int
1029 PAF_ASIT_initPhaseMalloc(
1030     const PAF_ASIT_Params *pP, 
1031     const PAF_ASIT_Patchs *pQ, 
1032     PAF_ASIT_Config *pC
1035     PAF_AST_Config *pAstCfg;
1036     Int as;                    /* Audio Stream Number (1, 2, etc.) */
1037     Int zMS;
1038     Error_Block    eb;
1040     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1041     as = pAstCfg->as;
1042     zMS = pAstCfg->masterStr;
1043     
1044     TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: initialization phase - memory allocation", as+zMS);
1046     // Initialize error block
1047     Error_init(&eb); 
1049     /* Input memory */
1050     if (!(pAstCfg->xInp = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, 
1051         INPUTN * sizeof (*pAstCfg->xInp), 4, &eb)))
1052     {
1053         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
1054         SW_BREAKPOINT;
1055         return __LINE__;
1056     }
1057     TRACE_TERSE3("PAF_ASIT_initPhaseMalloc. (pC->xInp) %d bytes from space %d at 0x%x.",
1058         INPUTN * sizeof (*pAstCfg->xInp),
1059         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xInp);
1061 #ifdef NON_CACHE_STATUS
1062     /* Decode memory */
1063     if (!(pAstCfg->xDec = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM,
1064         DECODEN * sizeof (*pAstCfg->xDec), 4, &eb)))
1065     {
1066         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
1067         SW_BREAKPOINT;
1068         return __LINE__;
1069     }
1070 #else
1071     /* Decode memory */
1072     if (!(pAstCfg->xDec = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, 
1073         DECODEN * sizeof (*pAstCfg->xDec), 4, &eb)))
1074     {
1075         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
1076         SW_BREAKPOINT;
1077         return __LINE__;
1078     }
1079 #endif
1080     TRACE_TERSE3("PAF_ASIT_initPhaseMalloc. (pC->xDec) %d bytes from space %d at 0x%x.",
1081         DECODEN * sizeof (*pAstCfg->xDec),
1082         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xDec);
1083                 
1084     TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: initialization phase - memory allocation complete.", as+zMS);
1085     return 0;
1086 } //PAF_ASIT_initPhaseMalloc
1088 // -----------------------------------------------------------------------------
1089 // ASIT Initialization Function - Memory Initialization from Configuration
1090 //
1091 //   Name:      PAF_ASIT_initPhaseConfig
1092 //   Purpose:   Audio Stream Task Function for initialization of data values
1093 //              from parameters.
1094 //   From:      audioStream1Task or equivalent
1095 //   Uses:      See code.
1096 //   States:    x
1097 //   Return:    0 on success.
1098 //              Other as per initFrame0 and initFrame1.
1099 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1100 //              * State information as per parent.
1101 //
1102 Int
1103 PAF_ASIT_initPhaseConfig(
1104     const PAF_ASIT_Params *pP, 
1105     const PAF_ASIT_Patchs *pQ, 
1106     PAF_ASIT_Config *pC
1109     PAF_AST_Config *pAstCfg;
1110     Int as;                    /* Audio Stream Number (1, 2, etc.) */
1111     Int z;                     /* input/encode/stream/decode/output counter */
1112     Int zMS;
1114     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1115     as = pAstCfg->as;
1116     zMS = pAstCfg->masterStr;
1117     
1118     TRACE_TERSE1("PAF_ASIT_initPhaseConfig: AS%d: initialization phase - configuration", as+zMS);
1120     //
1121     // Unspecified elements have been initialized to zero during alloc
1122     //
1123     
1124     for (z=INPUT1; z < INPUTN; z++) 
1125     {
1126         pAstCfg->xInp[z].inpBufStatus = *pP->pInpBufStatus;
1127         pAstCfg->xInp[z].inpBufConfig.pBufStatus = &pAstCfg->xInp[z].inpBufStatus;
1128     }
1130     for (z=DECODE1; z < DECODEN; z++) 
1131     {
1132         Int zI = pP->inputsFromDecodes[z];
1133         pAstCfg->xDec[z].decodeControl.size = sizeof(pAstCfg->xDec[z].decodeControl);
1134         pAstCfg->xDec[z].decodeControl.pInpBufConfig = (const PAF_InpBufConfig *)&pAstCfg->xInp[zI].inpBufConfig;
1135         //pC->xDec[z].decodeStatus = *pP->z_pDecodeStatus[z]; // FL: slave
1136     }
1138     TRACE_TERSE1("PAF_ASIT_initPhaseConfig: AS%d: initialization phase - configuration complete.", as+zMS);
1139     return 0;
1140 } //PAF_ASIT_initPhaseConfig
1142 // -----------------------------------------------------------------------------
1143 // ASIT Initialization Function - ACP Algorithm Instantiation
1144 //
1145 //   Name:      PAF_ASIT_initPhaseAcpAlg
1146 //   Purpose:   Audio Stream Input Task Function for initialization of ACP by
1147 //              instantiation of the algorithm.
1148 //   From:      audioStream1Task or equivalent
1149 //   Uses:      See code.
1150 //   States:    x
1151 //   Return:    0 on success.
1152 //              Source code line number on ACP Algorithm creation failure.
1153 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1154 //              * State information as per parent.
1155 //              * Memory allocation errors.
1156 //
1157 Int
1158 PAF_ASIT_initPhaseAcpAlg(
1159     const PAF_ASIT_Params *pP, 
1160     const PAF_ASIT_Patchs *pQ, 
1161     PAF_ASIT_Config *pC
1164     PAF_AST_Config *pAstCfg;
1165     Int as;                 /* Audio Stream Number (1, 2, etc.) */
1166     Int z;                  /* input/encode/stream/decode/output counter */
1167     Int betaPrimeOffset;
1168     ACP_Handle acp;
1169     Int zMS;
1170     Int zS, zX;
1172     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1173     as = pAstCfg->as;
1174     zMS = pAstCfg->masterStr;
1175     
1176     TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: initialization phase - ACP Algorithm", as+zMS);
1178     ACP_MDS_init();
1180     if (!(acp = (ACP_Handle)ACP_MDS_create(NULL))) 
1181     {
1182         TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: ACP algorithm instance creation failed", as+zMS);
1183         return __LINE__;
1184     }
1185     pC->acp = acp;
1187     ((ALG_Handle)acp)->fxns->algControl((ALG_Handle) acp,
1188         ACP_GETBETAPRIMEOFFSET, (IALG_Status *)&betaPrimeOffset);
1190     for (z=INPUT1; z < INPUTN; z++) 
1191     {
1192         zS = z;
1193         for (zX = DECODE1; zX < DECODEN; zX++) 
1194         {
1195             if (pP->inputsFromDecodes[zX] == z) 
1196             {
1197                 zS = pP->streamsFromDecodes[zX];
1198                 break;
1199             }
1200         }
1201         acp->fxns->attach(acp, ACP_SERIES_STD,
1202             STD_BETA_IB + betaPrimeOffset * (as-1+zS),
1203             (IALG_Status *)&pAstCfg->xInp[z].inpBufStatus);
1204         /* Ignore errors, not reported. */
1205     }
1207     TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: initialization phase - ACP Algorithm complete.", as+zMS);
1209     return 0;
1210 } //PAF_ASIT_initPhaseAcpAlg
1212 // -----------------------------------------------------------------------------
1213 // ASIT Initialization Function - Common Memory
1214 //
1215 //   Name:      PAF_ASIT_initPhaseCommon
1216 //   Purpose:   Audio Stream Input Task Function for allocation of common memory.
1217 //   From:      audioStream1Task or equivalent
1218 //   Uses:      See code.
1219 //   States:    x
1220 //   Return:    0 on success.
1221 //              Source code line number on PAF_ALG_alloc failure.
1222 //              Source code line number on PAF_ALG_mallocMemory failure.
1223 //              Source code line number on Decode Chain initialization failure.
1224 //              Source code line number on ASP Chain initialization failure.
1225 //              Source code line number on Encode Chain initialization failure.
1226 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1227 //              * State information as per parent.
1228 //              * Memory allocation errors.
1229 //
1230 Int
1231 PAF_ASIT_initPhaseCommon(
1232     const PAF_ASIT_Params *pP, 
1233     const PAF_ASIT_Patchs *pQ, 
1234     PAF_ASIT_Config *pC
1237     PAF_AST_Config *pAstCfg;
1238     Int as;                     /* Audio Stream Number (1, 2, etc.) */
1239     Int z;                      /* stream counter */
1240     ACP_Handle acp;
1241     PAF_IALG_Config pafAlgConfig;
1242     IALG_MemRec common[3][PAF_IALG_COMMON_MEMN+1];
1243    
1244     acp = pC->acp;
1245     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1246     as = pAstCfg->as;
1247     
1248     TRACE_TERSE0("PAF_ASIT_initPhaseCommon: initialization phase - Common Memory");
1250     //
1251     // Determine memory needs and instantiate algorithms across audio streams
1252     //
1253     TRACE_TERSE0("PAF_ASIT_initPhaseCommon: calling PAF_ALG_setup.");
1254     PAF_ALG_setup(&pafAlgConfig, 
1255         HEAP_ID_INTERNAL,               HEAP_INTERNAL, 
1256         HEAP_ID_INTERNAL1,              HEAP_INTERNAL1, 
1257         HEAP_ID_EXTERNAL,               HEAP_EXTERNAL, 
1258         HEAP_ID_INTERNAL1_SHM,          HEAP_INTERNAL1_SHM, 
1259         HEAP_ID_EXTERNAL_SHM,           HEAP_EXTERNAL_SHM, 
1260         HEAP_ID_EXTERNAL_NONCACHED_SHM, HEAP_EXTERNAL_NONCACHED_SHM,
1261         HEAP_CLEAR);
1263     if (pP->fxns->headerPrint)
1264     {
1265         pP->fxns->headerPrint();        
1266     }
1268     for (z = STREAM1; z < STREAMN; z++) 
1269     {
1270         TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: initialization phase - Common Memory", as+z);
1272         //
1273         // Determine common memory for:
1274         //  (1) Logical Input drivers
1275         //
1276         // Decode Algorithms common memory determined in ASP Slave.
1277         //
1278         PAF_ALG_init(common[z], lengthof(common[z]), COMMONSPACE);
1280         //
1281         // Determine common memory needs of Logical Input driver
1282         //
1284         // really need to loop over all inputs for this stream using the tables
1285         // inputsFromDecodes and streamsFromDecodes. But these don't exist for this
1286         // patch, and not needed for FS11, since there is only one input.
1287         if (INPUT1 <= z && z < INPUTN) 
1288         {
1289             TRACE_TERSE2("PAF_ASIT_initPhaseCommon: AS%d: alloc inpLinkInit common[%d]", as+z, z);
1290             if (PAF_ALG_ALLOC(inpLinkInit[z-INPUT1], common[z]))
1291             {
1292                 TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: PAF_ALG_alloc failed", as+z);
1293                 TRACE_TERSE2("failed to alloc %d bytes from space %d", common[z]->size, (IArg)common[z]->space);
1294                 SW_BREAKPOINT;
1295                 return __LINE__;
1296             }
1297             TRACE_TERSE3("alloced %d bytes from space %d at 0x%x", common[z]->size, common[z]->space, (IArg)common[z]->base);
1298             if (pP->fxns->allocPrint)
1299             {
1300                 pP->fxns->allocPrint((const PAF_ALG_AllocInit *)(inpLinkInit[z-INPUT1]), sizeof (*(inpLinkInit[z-INPUT1])), &pafAlgConfig);
1301             }
1302         }
1303     }
1304     {
1305         // Changes made to share scratch between zones
1306         // Assume maximum 3 zones and scratch common memory is at offset 0;
1307         int max=0;
1308         for (z=STREAM1; z<STREAMN; z++)
1309         {
1310             if (max < common[z][0].size)
1311             {
1312                 max = common[z][0].size;
1313             }
1314         }
1315         common[STREAM1][0].size=max;
1316         for (z=STREAM1+1; z<STREAMN; z++)
1317         {
1318             common[z][0].size = 0;            
1319         }
1320     }
1321         
1322     //
1323     // Allocate common memory for:
1324     //  (1) Logical Input drivers
1325     //
1326     for (z = STREAM1; z < STREAMN; z++) 
1327     {
1328         TRACE_TERSE0("PAF_ASIT_initPhaseCommon: calling PAF_ALG_mallocMemory for common space.");
1329         if (PAF_ALG_mallocMemory(common[z], &pafAlgConfig)) 
1330         {
1331             TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: PAF_ALG_mallocMemory failed", as+z);
1332             TRACE_TERSE3("AS%d: z: %d.  Size 0x%x", as+z, z, common[z][0].size);
1333             SW_BREAKPOINT;
1334             return __LINE__;
1335         }
1336         TRACE_TERSE3("alloced %d bytes from space %d at 0x%x", common[z]->size, common[z]->space, (IArg)common[z]->base);
1337         // share zone0 scratch with all zones 
1338         common[z][0].base = common[0][0].base;
1339         if (pP->fxns->commonPrint)
1340         {
1341             pP->fxns->commonPrint(common[z], &pafAlgConfig);
1342         }
1344         //
1345         // Allocate non-common memories for Logical IO drivers
1346         //    Since these structures are used at run-time we allocate from external memory
1347         if (INPUT1 <= z && z < INPUTN) 
1348         {
1349             PAF_ASP_Chain *chain;
1350             TRACE_TERSE2("PAF_ASIT_initPhaseCommon: AS%d: non-common input chain init for %d",
1351                            as+z, z);
1352             chain = PAF_ASP_chainInit(&pAstCfg->xInp[z].inpChainData, pP->pChainFxns,
1353                         HEAP_EXTERNAL, as+z, acp, &trace,
1354                         inpLinkInit[z-INPUT1], NULL, common[z], &pafAlgConfig);
1355             if (!chain) 
1356             {
1357                 TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: Input chain initialization failed", as+z);
1358                 return __LINE__;
1359             }
1360         }
1361     }
1362     TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: Returning complete.", as+z);
1364     return 0;
1365 } //PAF_ASIT_initPhaseCommon
1367 // (***) FL: candidate for removal
1368 // -----------------------------------------------------------------------------
1369 // ASIT Initialization Function - Algorithm Keys
1370 //
1371 //   Name:      PAF_ASIT_initPhaseAlgKey
1372 //   Purpose:   Audio Stream Input Task Function for initialization of data values
1373 //              from parameters for Algorithm Keys.
1374 //   From:      audioStream1Task or equivalent
1375 //   Uses:      See code.
1376 //   States:    x
1377 //   Return:    0.
1378 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1379 //              * State information as per parent.
1380 //
1381 // .............................................................................
1382 Int
1383 PAF_ASIT_initPhaseAlgKey(
1384     const PAF_ASIT_Params *pP, 
1385     const PAF_ASIT_Patchs *pQ, 
1386     PAF_ASIT_Config *pC
1389     PAF_AST_Config *pAstCfg;
1390     Int as;                    /* Audio Stream Number (1, 2, etc.) */
1392     
1393     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1394     as = pAstCfg->as;
1395     (void)as;  // clear compiler warning in case not used with tracing disabled
1397     TRACE_VERBOSE1("PAF_ASIT_initPhaseAlgKey: AS%d: initialization phase - Algorithm Keys", as);
1399 #if 0 // FL: slave    
1400     for (z=DECODE1; z < DECODEN; z++) 
1401     {
1402         for (s=0; s < pP->pDecAlgKey->length; s++) 
1403         {
1404             if ((pP->pDecAlgKey->code[s].full != 0) &&
1405                 (that = PAF_ASP_chainFind (&pC->xDec[z].decChainData, pP->pDecAlgKey->code[s]))) 
1406             {
1407                 pC->xDec[z].decAlg[s] = (ALG_Handle )that->alg;
1408                 /* Cast in interface, for now --Kurt */
1409             }
1410             else
1411             {
1412                 pC->xDec[z].decAlg[s] = NULL;
1413             }
1414         }
1415     }
1416 #endif
1418     return 0;
1419 } //PAF_ASIT_initPhaseAlgKey
1421 // -----------------------------------------------------------------------------
1422 // ASIT Initialization Function - I/O Devices
1423 //
1424 //   Name:      PAF_ASIT_initPhaseDevice
1425 //   Purpose:   Audio Stream Input Task Function for initialization of I/O Devices.
1426 //   From:      audioStream1Task or equivalent
1427 //   Uses:      See code.
1428 //   States:    x
1429 //   Return:    0 on success.
1430 //              Source code line number on device allocation failure.
1431 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1432 //              * State information as per parent.
1433 //              * Memory allocation errors.
1434 //
1435 Int
1436 PAF_ASIT_initPhaseDevice(
1437     const PAF_ASIT_Params *pP, 
1438     const PAF_ASIT_Patchs *pQ, 
1439     PAF_ASIT_Config *pC
1442     PAF_AST_Config *pAstCfg;
1443     Int as;                             /* Audio Stream Number (1, 2, etc.) */
1444     Int z;                              /* input/output counter */
1445     PAF_SIO_IALG_Obj    *pObj;
1446     PAF_SIO_IALG_Config *pAlgConfig;
1447     PAF_IALG_Config pafAlgConfig;
1450     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1451     as = pAstCfg->as;
1452     (void)as; // clear compiler warning in case not used with tracing disabled
1454     TRACE_TERSE1("PAF_ASIT_initPhaseDevice: AS%d: initialization phase - I/O Devices", as);
1456     if (pP->fxns->bufMemPrint)
1457     {
1458         PAF_ALG_setup (&pafAlgConfig, 
1459             HEAP_ID_INTERNAL,               HEAP_INTERNAL, 
1460             HEAP_ID_INTERNAL1,              HEAP_INTERNAL1,
1461             HEAP_ID_EXTERNAL,               HEAP_EXTERNAL,
1462             HEAP_ID_INTERNAL1_SHM,          HEAP_INTERNAL1_SHM,
1463             HEAP_ID_EXTERNAL_SHM,           HEAP_EXTERNAL_SHM,
1464             HEAP_ID_EXTERNAL_NONCACHED_SHM, HEAP_EXTERNAL_NONCACHED_SHM,
1465             HEAP_CLEAR);
1466         TRACE_TERSE2("PAF_ASIT_initPhaseDevice: AS%d: calling PAF_ALG_setup with clear at %d.", as, HEAP_CLEAR);
1467     }
1469     for (z=INPUT1; z < INPUTN; z++) 
1470     {
1471         PAF_InpBufConfig *pConfig = &pAstCfg->xInp[z].inpBufConfig;
1473         pObj = (PAF_SIO_IALG_Obj *)pAstCfg->xInp[z].inpChainData.head->alg;
1474         pAlgConfig = &pObj->config;
1476         pAstCfg->xInp[z].hRxSio = NULL;
1478         pConfig->base.pVoid       = pAlgConfig->pMemRec[0].base;
1479         pConfig->pntr.pVoid       = pAlgConfig->pMemRec[0].base;
1480         pConfig->head.pVoid       = pAlgConfig->pMemRec[0].base;
1481         pConfig->futureHead.pVoid = pAlgConfig->pMemRec[0].base;
1482         pConfig->allocation       = pAlgConfig->pMemRec[0].size;
1483         pConfig->sizeofElement    = 2;
1484         pConfig->precision        = 16;
1486         if (pP->fxns->bufMemPrint)
1487         {
1488             pP->fxns->bufMemPrint(z, pAlgConfig->pMemRec[0].size, PAF_ALG_memSpaceToHeapId(&pafAlgConfig,pAlgConfig->pMemRec[0].space), 0);
1489         }
1490     }
1492     TRACE_TERSE1("PAF_ASIT_initPhaseDevice: AS%d: initialization phase - I/O Devices complete.", as);
1494     return 0;
1495 } //PAF_ASIT_initPhaseDevice
1497 // -----------------------------------------------------------------------------
1498 // ASIT Initialization Function - Decoder Output Circular Buffer
1499 //
1500 //   Name:      PAF_ASIT_initPhaseDecOpCircBuf
1501 //   Purpose:   Audio Stream Input Task Function for initialization of Decoder Output Circular Buffer.
1502 //   From:      audioStream1Task or equivalent
1503 //   Uses:      See code.
1504 //   States:    x
1505 //   Return:    0 on success.
1506 //              Source code line number on device allocation failure.
1507 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1508 //              * State information as per parent.
1509 //              * Memory allocation errors.
1510 //
1511 Int
1512 PAF_ASIT_initPhaseDecOpCircBuf(
1513     const PAF_ASIT_Params *pP, 
1514     const PAF_ASIT_Patchs *pQ, 
1515     PAF_ASIT_Config *pC
1518     PAF_AST_Config *pAstCfg;
1519     PAF_AST_DecOpCircBuf *pCb;          /* Decoder output circular buffer */
1520     Int as;                             /* Audio Stream Number (1, 2, etc.) */
1521     Int zMS;
1522     Int z;                              /* decode counter */
1523     Int errno;                          /* error number */
1524     Error_Block    eb;
1525     Int i;
1527     // FL: (***)revisit
1528     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1529     as = pAstCfg->as;
1530     zMS = pAstCfg->masterStr;
1532     /* Decode output circular buffer memory */
1533     if (!(pAstCfg->xDecOpCb = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, 
1534         DECODEN * sizeof (*pAstCfg->xDecOpCb), 4, &eb)))
1535     {
1536         TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1537         SW_BREAKPOINT;
1538         return __LINE__;
1539     }
1541     TRACE_TERSE3("PAF_ASIT_initPhaseDecOpCircBuf. (pC->xDecOpCb) %d bytes from space %d at 0x%x.",
1542         DECODEN * sizeof (*pAstCfg->xDecOpCb),
1543         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xDecOpCb);
1544         
1545     for (z=DECODE1; z < DECODEN; z++)
1546     {
1547         pCb = &pAstCfg->xDecOpCb[z];
1548         
1549         // allocate audio frame circular buffer
1550         if (!(pCb->afCb = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, ASP_DECOP_CB_MAX_NUM_AF * sizeof(PAF_AudioFrame), 4, &eb)))
1551         {
1552             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1553             SW_BREAKPOINT;
1554         }
1555         // allocate audio frame PCM sample pointer array
1556         for (i = 0; i<ASP_DECOP_CB_MAX_NUM_AF; i++)
1557         {
1558             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)))
1559             {
1560                 TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1561                 SW_BREAKPOINT;
1562             }
1563             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)))
1564             {
1565                 TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1566                 SW_BREAKPOINT;
1567             }                
1568         }
1569         // allocate PCM sample buffer
1570         if (!(pCb->pcmBuf = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_SHM, ASP_DECOP_CB_PCM_BUF_SZ * sizeof(PAF_AudioData), 4, &eb)))
1571         {
1572             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1573             SW_BREAKPOINT;
1574         }
1575         pCb->pcmBufEnd = pCb->pcmBuf + ASP_DECOP_CB_PCM_BUF_SZ;
1576         // allocate Metadata buffers //QIN
1577         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)))
1578         {
1579             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1580             SW_BREAKPOINT;
1581         }
1582         pCb->metaBufEnd = pCb->metaBuf + (ASP_DECOP_CB_MAX_NUM_AF * PAF_MAX_PRIVATE_MD_SZ * PAF_MAX_NUM_PRIVATE_MD);
1583         // (***) FL: revisit, here PCM is hard-coded for 256 sample dec op frame length        
1584         // Initialize decoder output circular buffer for PCM
1585         errno = cbInit(pCb);
1586         if (errno)
1587         {
1588             SW_BREAKPOINT; // FL: debug
1589             return errno;
1590         }
1591     }
1593     return 0;
1594 } //PAF_ASIT_initPhaseDecOpCircBuf
1597 #if 0
1598 // -----------------------------------------------------------------------------
1599 // AST Processing Function - Pass-Through Processing
1600 //
1601 //   Name:      PAF_AST_passProcessing
1602 //   Purpose:   Audio Stream Task Function for processing audio data as a
1603 //              pass-through from the input driver to the output driver
1604 //              for development and testing.
1605 //   From:      audioStream1Task or equivalent
1606 //   Uses:      See code.
1607 //   States:    x
1608 //   Return:    Error number in standard form (0 on success).
1609 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1610 //              * State information on initialization.
1611 //              * State information on processing.
1612 //
1614 #pragma CODE_SECTION(PAF_AST_passProcessing,".text:_PAF_AST_passProcessing")
1615 /* Pass Processing is often omitted from builds to save memory, */
1616 /* and CODE_SECTION/clink constructs facilitate this omission.  */
1618 Int
1619 PAF_AST_passProcessing(const PAF_AST_Params *pP, const PAF_AST_Patchs *pQ, PAF_AST_Config *pC, Int hack)
1621     Int z;                              /* input/output counter */
1622     Int errno = 0;                      /* error number */
1623     Int getVal;
1624     Int rxNumChan, txNumChan;
1625     Int first;
1626     Int zMD = pC->masterDec;
1627     Int zMI = pP->zone.master;
1630 #ifndef __TI_EABI__
1631     asm (" .clink"); /* See comment above regarding CODE_SECTION/clink. */
1632 #endif    
1634     TRACE_VERBOSE0("PAF_AST_passProcessing: initializing");
1636     //
1637     // Determine that receive/transmit channels are compatible
1638     //
1640     // Can handle handle only master input
1641     for (z=INPUT1; z < INPUTN; z++) {
1642         if (z != zMI && pC->xInp[z].hRxSio)
1643             return (ASPERR_PASS + 0x01);
1644     }
1646     /* Number of receive/transmit channels */
1648     if (! pC->xInp[zMI].hRxSio)
1649         return (ASPERR_PASS + 0x11);
1650     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &rxNumChan))
1651         return (ASPERR_PASS + 0x12);
1652     if (rxNumChan > NUM_TX_CHAN(zMI))
1653         return (ASPERR_PASS + 0x13);
1655     for (z=OUTPUT1; z < OUTPUTN; z++) {
1656         if (! pC->xOut[zMI].hTxSio)
1657             return (ASPERR_PASS + 0x10*(z+2) + 0x01);
1658         if (SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &txNumChan))
1659             return (ASPERR_PASS + 0x10*(z+2) + 0x02);
1660         if (txNumChan > NUM_TX_CHAN(zMI))
1661             return (ASPERR_PASS + 0x10*(z+2) + 0x03);
1662     }
1664     //
1665     // Set up receive/transmit
1666     //
1668     SIO_idle (pC->xInp[zMI].hRxSio);
1669     for (z=OUTPUT1; z < OUTPUTN; z++) {
1670         if(SIO_idle (pC->xOut[z].hTxSio))
1671             return ASPERR_IDLE;
1672     }
1674     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_SET_SOURCESELECT, PAF_SOURCE_PCM))
1675         return (ASPERR_PASS + 0x14);
1677     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, FRAMELENGTH))
1678         return (ASPERR_PASS + 0x15);
1680     for (z=OUTPUT1; z < OUTPUTN; z++)
1681         pC->xOut[z].outBufConfig.lengthofFrame = FRAMELENGTH;
1683     if (SIO_issue (pC->xInp[zMI].hRxSio, &pC->xInp[zMI].inpBufConfig, sizeof (pC->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_SYNC))
1684         return ASPERR_PASS + 0x16;
1686     if (SIO_reclaim (pC->xInp[zMI].hRxSio, (Ptr)&pC->xInp[zMI].pInpBuf, NULL) != sizeof (PAF_InpBufConfig))
1687         return ASPERR_PASS + 0x17;
1689     //
1690     // Receive and transmit the data in single-frame buffers
1691     //
1693     first = 1;
1694     while (pC->xDec[zMD].decodeStatus.sourceSelect == PAF_SOURCE_PASS) {
1695         PAF_OutBufConfig *pOutBuf;
1696         PAF_InpBufConfig *pInpBuf;
1698         if (first) {
1699             first = 0;
1701             TRACE_VERBOSE0("PAF_AST_passProcessing: starting output");
1703             for (z=OUTPUT1; z < OUTPUTN; z++) {
1704                 getVal = SIO_issue (pC->xOut[z].hTxSio, &pC->xOut[z].outBufConfig, sizeof(pC->xOut[z].outBufConfig), 0);
1705                 if (getVal > 0) {
1706                     errno = ASPERR_ISSUE;
1707                     break;
1708                 }
1709                 else if (getVal < 0) {
1710                     errno = -getVal;
1711                     break;
1712                 }
1714                 if (getVal = SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_UNMUTE, 0))
1715                     return (getVal & 0xff) | ASPERR_MUTE;
1716             }
1717             if (errno)
1718                 break;
1720         }
1722         getVal = SIO_issue (pC->xInp[zMI].hRxSio, &pC->xInp[zMI].inpBufConfig, sizeof (pC->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME);
1723         if (getVal > 0) {
1724             errno = ASPERR_ISSUE;
1725             break;
1726         }
1728         TRACE_VERBOSE1("PAF_AST_passProcessing: awaiting frame -- input size %d", rxNumChan * FRAMELENGTH);
1730         getVal = SIO_reclaim (pC->xInp[zMI].hRxSio, (Ptr) &pInpBuf, NULL);
1731         if (getVal < 0) {
1732             errno = -getVal;
1733             break;
1734         }
1736         for (z=OUTPUT1; z < OUTPUTN; z++) {
1737             getVal = SIO_reclaim (pC->xOut[z].hTxSio, (Ptr) &pOutBuf, NULL);
1738             if (getVal < 0) {
1739                 errno = -getVal;
1740                 break;
1741             }
1742         }
1743         if( errno )
1744             break;
1746         TRACE_VERBOSE0("PAF_AST_passProcessing: copying frame");
1748         if (errno = pP->fxns->passProcessingCopy (pP, pQ, pC))
1749             break;
1751         for (z=OUTPUT1; z < OUTPUTN; z++) {
1752             getVal = SIO_issue (pC->xOut[z].hTxSio, &pC->xOut[z].outBufConfig, sizeof(pC->xOut[z].outBufConfig), 0);
1753             if (getVal > 0) {
1754                 errno = ASPERR_ISSUE;
1755                 break;
1756             }
1757             else if (getVal < 0) {
1758                 errno = -getVal;
1759                 break;
1760             }
1761         }
1762         if( errno )
1763             break;
1764     }
1766     //
1767     // Close down receive/transmit
1768     //
1770     TRACE_TERSE0("PAF_AST_passProcessing: finalizing"));
1772     for (z=OUTPUT1; z < OUTPUTN; z++) {
1773         if (getVal = SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_MUTE, 0)) {
1774             if (! errno)
1775                 errno = (getVal & 0xff) | ASPERR_MUTE;
1776             /* convert to sensical errno */
1777         }
1778     }
1780     SIO_idle (pC->xInp[zMI].hRxSio);
1781     for (z=OUTPUT1; z < OUTPUTN; z++)
1782         SIO_idle (pC->xOut[z].hTxSio);
1784     return errno;
1786 } //PAF_AST_passProcessing
1787 #endif // #if 0
1789 #if 0
1790 // -----------------------------------------------------------------------------
1791 // AST Processing Function Helper - Pass-Through Processing Patch Point
1792 //
1793 //   Name:      PAF_AST_passProcessingCopy
1794 //   Purpose:   Pass-Through Processing Function for copying audio data
1795 //              from the input buffer to the output buffer.
1796 //   From:      AST Parameter Function -> passProcessing
1797 //   Uses:      See code.
1798 //   States:    x
1799 //   Return:    Error number in standard form (0 on success).
1800 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1801 //              x
1802 //
1804 #pragma CODE_SECTION(PAF_AST_passProcessingCopy,".text:_PAF_AST_passProcessingCopy")
1805 /* Pass Processing is often omitted from builds to save memory, */
1806 /* and CODE_SECTION/clink constructs facilitate this omission.  */
1808 Int
1809 PAF_AST_passProcessingCopy (const PAF_AST_Params *pP, const PAF_AST_Patchs *pQ, PAF_AST_Config *pC)
1811     Int z;                              /* output counter */
1812     Int errno;                          /* error number */
1813     Int i;
1814     Int rxNumChan, txNumChan;
1815     Int zMI = pP->zone.master;
1818     asm (" .clink"); /* See comment above regarding CODE_SECTION/clink. */
1820     // Copy data from input channels to output channels one of two ways:
1822     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &rxNumChan))
1823         return (ASPERR_PASS + 0x12);
1825     for (z=OUTPUT1; z < OUTPUTN; z++) {
1826         if (SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &txNumChan))
1827             return (ASPERR_PASS + 0x22);
1829         if( txNumChan <= rxNumChan ) {
1831             // Copy one to one, ignoring later rx channels as needed.
1833             for( i=0; i < txNumChan; i++ ) {
1834                 errno = pP->fxns->copy( i, &pC->xInp[zMI].inpBufConfig, i, &pC->xOut[z].outBufConfig );
1835                 if( errno )
1836                     return errno;
1837             }
1838         }
1839         else {
1841             // Copy one to many, repeating earlier rx channels as needed.
1843             Int from, to;
1845             from = 0;
1846             to   = 0;
1847             while( to < txNumChan ) {
1848                 errno = pP->fxns->copy( from, &pC->xInp[zMI].inpBufConfig, to, &pC->xOut[z].outBufConfig );
1849                 if( errno )
1850                     return errno;
1852                 from++;
1853                 to++;
1854                 if( from == rxNumChan )
1855                     from = 0;
1856             }
1857         }
1858     }
1860     return 0;
1861 } //PAF_AST_passProcessingCopy
1862 #endif // #if 0
1864 // -----------------------------------------------------------------------------
1865 // ASIT Processing Function - Auto Processing
1866 //
1867 //   Name:      PAF_ASIT_autoProcessing
1868 //   Purpose:   Audio Stream Input Task Function for processing audio data to
1869 //              determine the input type without output.
1870 //   From:      audioStream1Task or equivalent
1871 //   Uses:      See code.
1872 //   States:    x
1873 //   Return:    Error number in standard or SIO form (0 on success).
1874 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1875 //              * State information on initialization.
1876 //
1878 #define DECSIOMAP(X)                                                \
1879     pP->pDecSioMap->map[(X) >= pP->pDecSioMap->length ? 0 : (X)]
1881 Int
1882 PAF_ASIT_autoProcessing(
1883     const PAF_ASIT_Params *pP, 
1884     const PAF_ASIT_Patchs *pQ, 
1885     PAF_ASIT_Config *pC, 
1886     Int inputTypeSelect, 
1887     ALG_Handle pcmAlgMaster
1890     PAF_AST_Config *pAstCfg;
1891     Int as;                 /* Audio Stream Number (1, 2, etc.) */
1892     Int errno = 0;          /* error number */
1893     Int nbytes;
1894     Int frameLength;
1895     Int zMD;
1896     Int zMI;
1897     Int zMS;
1898     
1899     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1900     as = pAstCfg->as;
1901     zMD = pAstCfg->masterDec;
1902     zMS = pAstCfg->masterStr;    
1903     zMI = pP->zone.master;    
1904     
1905     TRACE_VERBOSE1("PAF_ASIT_autoProcessing: AS%d: PAF_AST_autoProcessing", as+zMS);
1907     if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio,
1908                          PAF_SIO_CONTROL_SET_SOURCESELECT,
1909                          DECSIOMAP(pAstCfg->xDec[zMD].decodeStatus.sourceSelect)))
1910     {
1911         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: AS%d: source select returns 0x%x", as+zMS, errno);
1912         return errno;
1913     }
1914     //frameLength = pP->fxns->computeFrameLength (pcmAlgMaster, FRAMELENGTH,
1915     //                                            pC->xDec[zMD].decodeStatus.bufferRatio);
1916     frameLength = FRAMELENGTH; // FL: fix PCM frameLength for alpha release.
1918     if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio,
1919                          PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, frameLength))
1920     {
1921         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: SET_PCMFRAMELENGTH returns 0x%x, returning ASPERR_AUTO_LENGTH, 0x%x",
1922             errno, ASPERR_AUTO_LENGTH);
1923         return ASPERR_AUTO_LENGTH;
1924     }
1926     if (errno = SIO_issue(pAstCfg->xInp[zMI].hRxSio,
1927                           &pAstCfg->xInp[zMI].inpBufConfig, sizeof(pAstCfg->xInp[zMI].inpBufConfig),
1928                           PAF_SIO_REQUEST_SYNC))
1929     {
1930         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: REQUEST_SYNC returns 0x%x, returning ASPERR_ISSUE, 0x%x",
1931             errno, ASPERR_ISSUE);
1932         return ASPERR_ISSUE;
1933     }
1935     TRACE_VERBOSE1("PAF_ASIT_autoProcessing: AS%d: awaiting sync", as+zMS);
1937     // all of the sync scan work is done in this call. If the error returned
1938     // is DIBERR_SYNC then that just means we didn't find a sync, not a real I/O
1939     // error so we mask it off.
1940     nbytes = SIO_reclaim(pAstCfg->xInp[zMI].hRxSio, (Ptr)&pAstCfg->xInp[zMI].pInpBuf, NULL);
1941     if (nbytes == -DIBERR_SYNC)
1942     {
1943 #if 1 // (***) FL: shows timing of autosync restart
1944         // (***) debug // B5
1945         {
1946             static Uint8 toggleState = 0;
1947             if (toggleState == 0)
1948                 GPIOSetOutput(GPIO_PORT_0, GPIO_PIN_99);
1949             else
1950                 GPIOClearOutput(GPIO_PORT_0, GPIO_PIN_99);
1951             toggleState = ~(toggleState);
1952         }
1953 #endif        
1954         pfpEnd(PFP_ID_ASIT_0, PFP_FINISH_MEAS);
1955         pfpBegin(PFP_ID_ASIT_0, pC->taskHandle);
1956         
1957         TRACE_TERSE2("PAF_ASIT_autoProcessing: AS%d: SIO_reclaim returned 0x%x, ignoring", as+zMS, nbytes);
1958         return nbytes;
1959     }
1960     if (nbytes != sizeof(PAF_InpBufConfig))
1961     {
1962         TRACE_TERSE3("PAF_ASIT_autoProcessing. SIO_reclaim returned %d, not %d, returning ASPERR_RECLAIM (0x%x)",
1963             nbytes, sizeof(PAF_InpBufConfig), ASPERR_RECLAIM);
1964         return ASPERR_RECLAIM;
1965     }
1966     if (errno)
1967     {
1968         TRACE_TERSE2("PAF_ASIT_autoProcessing: AS%d: returning errno 0x%x", as+zMS, errno);
1969     }
1970     return errno;
1971 } //PAF_ASIT_autoProcessing
1973 UInt32 gProbe1Err=0;
1974 UInt32 gProbe2Err=0;
1975 UInt32 gMajorAuMissed=0;
1977 // -----------------------------------------------------------------------------
1978 // ASIT Processing Function - Decode Processing
1979 //
1980 //   Name:      PAF_ASIT_decodeProcessing
1981 //   Purpose:   Audio Stream Input Task Function for processing audio data.
1982 //   From:      audioStream1Task or equivalent
1983 //   Uses:      See code.
1984 //   States:    x
1985 //   Return:    Error number in standard form (0 on success).
1986 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1987 //              * State information on initialization (via children).
1988 //              * State information on processing (via children).
1989 //              * Decode warnings.
1990 //
1991 // When "writeDECModeContinuous" is used for zMI input/decode:
1992 // PAF_AST_decodeProcessing() loop may be (is designed to be) exited:
1993 // (a) if "writeDECCommandRestart" is used
1994 //    (or "writeDECCommandAbort", but this performs no cleanup whatsoever, and so its use is discouraged)
1995 // (b) if "writeDECSourceSelectNone" is used
1996 // [ the latter events lead to QUIT state, simply for exiting (errme = errno = ASPERR_QUIT)
1997 // (c) if an error occurs in
1998 //     INIT
1999 //     CONT ("subsequent block state", which "Establish[es] secondary timing")
2000 //         -> PAF_AST_decodeCont(): "Await slave inputs"
2001 //     STREAM (errno |= PAF_COMPONENT_ASP)
2002 //     ENCODE (errno |= PAF_COMPONENT_ENCODE)
2003 // [ the latter errors lead to "switch_break:"
2004 //         -> PAF_AST_decodeComplete(), which always returns 0 (no error) ]
2005 //
2006 // [ Notably, in FINAL ("frame-finalization state")
2007 //         -> PAF_AST_decodeFinalTest() is *not* called,
2008 //   and so any other (asynchronous) changes in pC->xDec[zMD].decodeStatus.sourceSelect are ignored. ]
2009 // [ For completeness, note also: "default" state, internal check (errme = errno = ASPERR_UNKNOWNSTATE) ]
2010 //
2011 // States in which error can't occur:
2012 //     AGAIN ("subsequent initial state")
2013 //
2014 // States in which (some) errors must be handled:
2015 //     INFO1 ("first frame state")
2016 //         -> PAF_AST_decodeInfo(): pass on ASPERR_INFO_RATECHANGE, ASPERR_INFO_PROGRAM ("bad" internal error)
2017 //            -> *DONE* must "catch" ASPERR_RECLAIM from SIO_reclaim (pC->xInp[zMI].hRxSio) -- note zMI only **
2018 //               ?*? but what about ASPERR_RESYNC from same call ?*?
2019 //            -> *for now, at least, pass on error from pP->fxns->updateInputStatus ()*
2020 //            -> *DONE* must "catch" error from (zMI) dec->fxns->info() **
2021 //         -> PAF_AST_decodeInfo1(): pass on any errors which occur here:
2022 //            - pP->fxns->streamChainFunction (... PAF_ASP_CHAINFRAMEFXNS_RESET)
2023 //            - enc->fxns->info()
2024 //            - pP->fxns->setCheckRateX()
2025 //            - pP->fxns->startOutput()
2026 //            - "Start slave inputs if necessary"
2027 //     INFO2 ("subsequent frame state")
2028 //         -> PAF_AST_decodeInfo(): (see above)
2029 //         -> PAF_AST_decodeInfo2(): pass on any errors which occur here:
2030 //            - pP->fxns->setCheckRateX()
2031 //     TIME ("timing state")
2032 //         -> PAF_AST_decodeTime(): "Special timing consideations for AC-3"
2033 //         -> performs SIO_issue (... PAF_SIO_REQUEST_FULLFRAME) & SIO_reclaim() *for zMI only*
2034 //         -> now, DIB_issue [PAF_SIO_REQUEST_FULLFRAME] would only return SYS_EINVAL for "bad" internal error
2035 //            (*OK* don't try to recover from this*)
2036 //         -> much more likely would be SIO_reclaim() error (ASPERR_RECLAIM)
2037 //         -> *DONE* must "catch" (just) ASPERR_RECLAIM error -- note zMI only,
2038 //            possibly in PAF_AST_decodeProcessing() itself **
2039 //     DECODE ("decode state")
2040 //         -> PAF_AST_decodeDecode(): pass on error from
2041 //            - PAF_SIO_CONTROL_GET_NUM_REMAINING ("bad" internal error)
2042 //            - dec->fxns->reset()
2043 //            - PAF_SIO_CONTROL_SET_PCMFRAMELENGTH
2044 //         -> *DONE* must catch error from (zMI) dec->fxns->decode()
2045 //         -> *?* must catch ASPERR_ISSUE from (zMI) SIO_issue()
2046 Int
2047 PAF_ASIT_decodeProcessing(
2048     const PAF_ASIT_Params *pP, 
2049     const PAF_ASIT_Patchs *pQ, 
2050     PAF_ASIT_Config *pC, 
2051     Int sourceSelect
2054     PAF_AST_Config *pAstCfg;
2055     //Int as = pC->as;                    /* Audio Stream Number (1, 2, etc.) */
2056     Int z;                              /* decode counter */
2057     Int errno;                          /* error number */
2058     Int getVal;
2059     enum { INIT, INFO1, INFO2, DECODE, FINAL, QUIT } state;
2060     ALG_Handle alg[DECODEN_MAX];
2061     Int zMD;
2062     Int zMS;
2063     Int size;
2064     //PAF_InpBufConfig *pIpBufConfig;
2065     Int frame; // decoder input frame count
2066     Int block; // (***) FL: formerly  -- decoder output block count / input frame
2067 #ifdef NON_CACHE_STATUS
2068     Int8 tempVar8, temp2Var8;
2069 #endif
2070     
2071     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
2072     zMD = pAstCfg->masterDec;
2073     zMS = pAstCfg->masterStr;
2074         
2075     for (z=DECODE1; z < DECODEN; z++)
2076     {
2077         alg[z] = pAstCfg->xDec[z].decAlg[PAF_SOURCE_PCM];        
2078     }
2079     alg[zMD] = NULL; // decAlgMaster; // FL: alg[] init is on slave
2081     //
2082     // Receive and process the data in single-frame buffers
2083     //
2085     state = INIT;
2086     errno = 0; /* error number */
2088 #ifdef NON_CACHE_STATUS
2089     statusOp_read(&tempVar8,
2090                   &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
2091                   sizeof(tempVar8),
2092                   GATEMP_INDEX_DEC);
2093     TRACE_TERSE1("PAF_ASIT_decodeProcessing: sourceSelect is %d", tempVar8);
2095     for (;;) 
2096     {
2097         statusOp_read(&tempVar8,
2098                       &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
2099                     sizeof(tempVar8),
2100                     GATEMP_INDEX_DEC);
2101         if (tempVar8 == PAF_SOURCE_NONE)
2102         {
2103 #else
2104     TRACE_TERSE1("PAF_ASIT_decodeProcessing: sourceSelect is %d", pAstCfg->xDec[zMD].decodeStatus.sourceSelect);
2106     for (;;)
2107     {
2108         if (pAstCfg->xDec[zMD].decodeStatus.sourceSelect == PAF_SOURCE_NONE)
2109         {
2110 #endif
2111             TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: sourceSelect == PAF_SOURCE_NONE");
2112             state = QUIT;
2113         }
2115         // Process commands (decode)
2116         if (getVal = pP->fxns->decodeCommand(pP, pQ, pC)) 
2117         {
2118             if (state != INIT)   // no need to restart/abort if not yet started
2119             {
2120                 if (getVal == ASPERR_QUIT)
2121                 {
2122                     state = QUIT;
2123                     TRACE_VERBOSE0("PAF_ASIT_decodeProcessing. %d: state = QUIT");
2124                 }
2125                 else if (getVal == ASPERR_ABORT)
2126                 {
2127                     TRACE_VERBOSE0("PAF_ASIT_decodeProcessing. %d: return getVal");
2128                     return getVal;
2129                 }
2130                 else
2131                 {
2132                     /* ignore */;
2133                 }
2134             }
2135             TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state == INIT");
2136         }
2138         TRACE_TIME((&TIME_MOD,         "... + %d = %d ->", dtime(), TSK_time()));
2139         TRACE_TIME((&TIME_MOD,         "                 state = %s", stateName[state]));
2141         // Process state (decode)
2142         switch (state) 
2143         {
2144             case INIT: // initial state
2145                 gAsipInitCnt++;
2146                 Log_info0("TaskAsip: state=INIT");               
2148                 if (errno = pP->fxns->decodeInit(pP, pQ, pC, sourceSelect))
2149                 {
2150                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INIT, errno 0x%x.  break after decodeInit", errno);
2151                     break;
2152                 }
2153                                
2154                 frame = 0;
2155                 block = 0;
2157                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INIT->INFO1");
2158                 state = INFO1;
2159                 continue;
2161             case INFO1: // first frame state
2162                 gAsipInfo1Cnt++;
2163                 Log_info0("TaskAsip: state=INFO1");
2164                 
2165                 // Establish primary timing
2166                 if (errno = pP->fxns->decodeInfo(pP, pQ, pC, frame, block))
2167                 {
2168                     gAsipInfo1_PrimaryErrCnt++;
2169                     TRACE_TERSE1("INFO1: errno 0x%x after decodeInfo, primary timing", errno);
2170                     break;
2171                 }
2172                 
2173 #ifdef NON_CACHE_STATUS
2174                 statusOp_read(&tempVar8,
2175                               &(pAstCfg->xDec[zMD].decodeStatus.sourceDecode),
2176                               sizeof(tempVar8),
2177                               GATEMP_INDEX_DEC);
2178                 statusOp_read(&temp2Var8,
2179                               &(pAstCfg->xDec[zMD].decodeStatus.sampleRate),
2180                               sizeof(tempVar8),
2181                               GATEMP_INDEX_DEC);
2182                 // Don't start decode until major access unit is found.
2183                 if (((tempVar8 == PAF_SOURCE_THD)    ||
2184                      (tempVar8 == PAF_SOURCE_DXP)    ||
2185                      (tempVar8 == PAF_SOURCE_DTSHD)) &&
2186                      (temp2Var8 == PAF_SAMPLERATE_UNKNOWN)) 
2187 #else
2188                 // Don't start decode until major access unit is found.
2189                 if (((pAstCfg->xDec[zMD].decodeStatus.sourceDecode == PAF_SOURCE_THD)    ||
2190                      (pAstCfg->xDec[zMD].decodeStatus.sourceDecode == PAF_SOURCE_DXP)    ||
2191                      (pAstCfg->xDec[zMD].decodeStatus.sourceDecode == PAF_SOURCE_DTSHD)) &&
2192                      (pAstCfg->xDec[zMD].decodeStatus.sampleRate == PAF_SAMPLERATE_UNKNOWN))
2193 #endif
2194                 {
2195                     Int z;
2196                     for (z=DECODE1; z < DECODEN; z++) 
2197                     {
2198                         Int zI = pP->inputsFromDecodes[z];
2199 #ifdef NON_CACHE_STATUS
2200                         statusOp_read(&tempVar8,
2201                                       &(pAstCfg->xDec[z].decodeStatus.mode),
2202                                       sizeof(tempVar8),
2203                                       GATEMP_INDEX_DEC);
2204                         if (pAstCfg->xInp[zI].hRxSio && tempVar8)
2205                         {
2206 #else
2207                         if (pAstCfg->xInp[zI].hRxSio && pAstCfg->xDec[z].decodeStatus.mode)
2208                         {
2209 #endif
2210                             TRACE_VERBOSE0("TaskAsip: PAF_ASIT_decodeProcessing: INFO1, SIO_issue");
2211                             if (SIO_issue(pAstCfg->xInp[zI].hRxSio, &pAstCfg->xInp[zI].inpBufConfig,
2212                                 sizeof(pAstCfg->xInp[zI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME))
2213                             {
2214                                 gProbe2Err++;
2215                                 TRACE_TERSE0("PAF_ASIT_decodeProcessing. %d: INFO1, return (ASPERR_ISSUE)");
2216                                 return (ASPERR_ISSUE);
2217                             }
2218                         }
2219                     }
2220                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1: frame %d, not major access unit", frame);
2221                     gMajorAuMissed++; // debug
2222                     frame++;
2223                     state = INFO1;
2224                     continue;
2225                 }
2226                 TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1: frame %d, major access unit found", frame);
2228                 // Establish secondary timing
2229                 if (errno = pP->fxns->decodeInfo1(pP, pQ, pC, frame, block))
2230                 {
2231                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1, errno 0x%x.  break after decodeInfo1", errno);
2232                     gAsipInfo1_ErrCnt++;
2233                     break;
2234                 }
2236                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INFO1->DECODE");
2237                 state = DECODE;
2238                 continue;
2240             case INFO2: // subsequent frame state
2241                 gAsipInfo2Cnt++;
2242                 Log_info0("TaskAsip: state=INFO2");
2244                 // Establish primary timing
2245                 if (errno = pP->fxns->decodeInfo(pP, pQ, pC, frame, block))
2246                 {
2247                     TRACE_TERSE1("PAF_ASIT_decodeProcessing: INFO2 break on decodeInfo. errno 0x%x", errno);
2248                     gAsipInfo2_PrimaryErrCnt++;
2249                     break;
2250                 }
2251                 
2252                 // Measure cycles in decode processing loop.
2253                 // Only measures cycles spent in loop.
2254                 pfpEnd(PFP_ID_ASIT_1, PFP_FINISH_MEAS);
2255                 pfpBegin(PFP_ID_ASIT_1, pC->taskHandle);
2257                 if (errno = pP->fxns->decodeInfo2(pP, pQ, pC, frame, block))
2258                 {
2259                     TRACE_TERSE1("PAF_ASIT_decodeProcessing. %d: INFO2 break on decodeInfo2. errno 0x%x", errno);
2260                     gAsipInfo2_ErrCnt++;
2261                     break;
2262                 }
2263                
2264                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INFO2->DECODE");
2265                 state = DECODE;
2266                 continue;
2268             case DECODE: // decode state
2269                 gAsipDecodeCnt++;
2270                 Log_info0("TaskAsip: state=DECODE");
2272                 if (errno = pP->fxns->decodeDecode(pP, pQ, pC, sourceSelect, frame, block))
2273                 {
2274                         gAsipDecodeErrCnt++;
2275                         TRACE_TERSE1("PAF_ASIT_decodeProcessing: state: DECODE.  decodeDecode err 0x%04x", errno);
2276                     break;
2277                 }
2278                 
2279                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: DECODE->FINAL");
2280                 state = FINAL;
2281                 continue;
2283             case FINAL: // frame-finalization state
2284                 gAsipFinalCnt++;
2285                 Log_info0("TaskAsip: state=FINAL");
2287                 // Check for final frame, and if indicated:
2288                 // - Exit state machine to "complete" processing.
2289                 if (pP->fxns->decodeFinalTest(pP, pQ, pC, frame, block)) 
2290                 {
2291                     break;
2292                 }
2294                 frame++;
2295                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: FINAL->AGAIN");
2296                 state = INFO2;
2297                 continue;
2299             case QUIT: // exit state
2300                 gAsipQuitCnt++;
2301                 Log_info0("TaskAsip: state=QUIT");
2303                 // Quit:
2304                 // - Set error number registers.
2305                 // - Exit state machine to "decode complete" processing.
2306                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: QUIT");
2307                 errno = ASPERR_QUIT;
2308                 break;
2310             default: // unknown state
2312                 // Unknown:
2313                 // - Set error number registers.
2314                 // - Exit state machine to "decode complete" processing.
2316                 TRACE_TERSE1("PAF_ASIT_decodeProcessing: state: unknown, 0x%x", state);
2317                 errno = ASPERR_UNKNOWNSTATE;
2318                 break;
2320         }  // End of switch (state).
2322         TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: Calling decode complete");
2323         if (pP->fxns->decodeComplete(pP, pQ, pC, alg, frame, block))
2324         {
2325             /* ignored? */;
2326         }
2327         
2328         TRACE_TIME((&TIME_MOD, "as1-f2: ... + %d = ?? (final? %d)", dtime(), state == FINAL));
2330         return errno;
2331     }  // End of for (;;) to Receive, process, and transmit the data.
2332 } //PAF_ASIT_decodeProcessing
2334 // -----------------------------------------------------------------------------
2335 // ASIT Decoding Function - Decode Command Processing
2336 //
2337 //   Name:      PAF_ASIT_decodeCommand
2338 //   Purpose:   Decoding Function for processing Decode Commands.
2339 //   From:      AST Parameter Function -> decodeProcessing
2340 //   Uses:      See code.
2341 //   States:    x
2342 //   Return:    Error number in standard form (0 on success).
2343 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2344 //              * Command execution.
2345 //
2347 Int
2348 PAF_ASIT_decodeCommand(
2349     const PAF_ASIT_Params *pP, 
2350     const PAF_ASIT_Patchs *pQ, 
2351     PAF_ASIT_Config *pC
2354     PAF_AST_Config *pAstCfg;
2355     Int as;                 /* Audio Stream Number (1, 2, etc.) */
2356     Int z;                  /* decode counter */
2357     Int zS;
2358 #ifdef NON_CACHE_STATUS
2359     Int8 tempVar8;
2360 #endif
2362     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
2363     as = pAstCfg->as;
2365     for (z=DECODE1; z < DECODEN; z++) 
2366     {
2367         zS = pP->streamsFromDecodes[z];
2368 #ifdef NON_CACHE_STATUS
2369         statusOp_read(&tempVar8,
2370                       &(pAstCfg->xDec[z].decodeStatus.command2),
2371                       sizeof(tempVar8),
2372                       GATEMP_INDEX_DEC);
2373         if (!(tempVar8 & 0x80))
2374         {
2375             switch (tempVar8)
2376             {
2377                 case 0: // command none - process
2378                     tempVar8 |= 0x80;
2379                     statusOp_write(&(pAstCfg->xDec[z].decodeStatus.command2),
2380                                    &tempVar8,
2381                                    sizeof(tempVar8),
2382                                    GATEMP_INDEX_DEC);
2383                     break;
2384                 case 1: // command abort - leave now
2385                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command abort (0x%02x)", as+zS, 1);
2386                     tempVar8 |= 0x80;
2387                     statusOp_write(&(pAstCfg->xDec[z].decodeStatus.command2),
2388                                    &tempVar8,
2389                                    sizeof(tempVar8),
2390                                    GATEMP_INDEX_DEC);
2391                     return (ASPERR_ABORT);
2392                 case 2: // command restart - leave later
2393                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command quit (0x%02x)", as+zS, 2);
2394                     tempVar8 |= 0x80;
2395                     statusOp_write(&(pAstCfg->xDec[z].decodeStatus.command2),
2396                                    &tempVar8,
2397                                    sizeof(tempVar8),
2398                                    GATEMP_INDEX_DEC);
2399                     return (ASPERR_QUIT);
2400                 default: // command unknown - ignore
2401                     break;
2402             }
2403         }
2404 #else
2405         if (!(pAstCfg->xDec[z].decodeStatus.command2 & 0x80))
2406         {
2407             switch (pAstCfg->xDec[z].decodeStatus.command2)
2408             {
2409                 case 0: // command none - process
2410                     pAstCfg->xDec[z].decodeStatus.command2 |= 0x80;
2411                     break;
2412                 case 1: // command abort - leave now
2413                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command abort (0x%02x)", as+zS, 1);
2414                     pAstCfg->xDec[z].decodeStatus.command2 |= 0x80;
2415                     return (ASPERR_ABORT);
2416                 case 2: // command restart - leave later
2417                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command quit (0x%02x)", as+zS, 2);
2418                     pAstCfg->xDec[z].decodeStatus.command2 |= 0x80;
2419                     return (ASPERR_QUIT);
2420                 default: // command unknown - ignore
2421                     break;
2422             }
2423         }
2424 #endif
2425     }
2427     return 0;
2428 } //PAF_ASIT_decodeCommand
2430 // -----------------------------------------------------------------------------
2431 // ASIT Decoding Function - Reinitialization of Decode
2432 //
2433 //   Name:      PAF_ASIT_decodeInit
2434 //   Purpose:   Decoding Function for reinitializing the decoding process.
2435 //   From:      AST Parameter Function -> decodeProcessing
2436 //   Uses:      See code.
2437 //   States:    x
2438 //   Return:    Error number in standard or SIO form (0 on success).
2439 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2440 //              * State information as per parent.
2441 //
2442 Int
2443 PAF_ASIT_decodeInit(
2444     const PAF_ASIT_Params *pP, 
2445     const PAF_ASIT_Patchs *pQ, 
2446     PAF_ASIT_Config *pC, 
2447     Int sourceSelect
2450     PAF_AST_Config *pAstCfg;
2451     PAF_AST_DecOpCircBufCtl *pCbCtl;    /* Decoder output circular buffer control */
2452     Int as;                             /* Audio Stream Number (1, 2, etc.) */
2453     Int z;                              /* decode/encode counter */
2454     Int errno;                          /* error number */
2455     Int zI, zS;
2456     Int zMD;
2457     Int zMI;
2458     ASP_Msg* pAspMsg;                   /* Messaging */
2459     Int argIdx;
2460     Int status;
2461 #ifdef NON_CACHE_STATUS
2462     Int8 tempVar8;
2463 #endif
2464     
2465     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
2466     as = pAstCfg->as;
2467     zMD = pAstCfg->masterDec;
2468     zMI = pP->zone.master;
2469     (void)as;  // clear compiler warning in case not used with tracing disabled
2470     
2471     pCbCtl = &pC->pAspmCfg->decOpCircBufCtl; // get pointer to circular buffer control
2473 #ifdef NON_CACHE_STATUS
2474     // reset frameCount
2475     for (z=DECODE1; z < DECODEN; z++)
2476     {
2477         statusOp_read(&tempVar8,
2478                       &(pAstCfg->xDec[z].decodeStatus.mode),
2479                       sizeof(tempVar8),
2480                       GATEMP_INDEX_DEC);
2481         if (tempVar8)
2482         {
2483             tempVar8 = 0;
2484             statusOp_write(&(pAstCfg->xDec[z].decodeStatus.frameCount),
2485                           &tempVar8,
2486                           sizeof(tempVar8),
2487                           GATEMP_INDEX_DEC);
2488         }
2489     }
2491     for (z=DECODE1; z < DECODEN; z++) 
2492     {
2493         zI = pP->inputsFromDecodes[z];
2494         zS = pP->streamsFromDecodes[z];
2495         (void)zS; // clear compiler warning in case not used with tracing disabled
2496         statusOp_read(&tempVar8,
2497                       &(pAstCfg->xDec[z].decodeStatus.mode),
2498                       sizeof(tempVar8),
2499                       GATEMP_INDEX_DEC);
2500         if (pAstCfg->xInp[zI].hRxSio && tempVar8)
2501         {
2502 #else
2503     // reset frameCount
2504     for (z=DECODE1; z < DECODEN; z++)
2505     {
2506         if (pAstCfg->xDec[z].decodeStatus.mode)
2507         {
2508             pAstCfg->xDec[z].decodeStatus.frameCount = 0;
2509         }
2510     }
2512     for (z=DECODE1; z < DECODEN; z++)
2513     {
2514         zI = pP->inputsFromDecodes[z];
2515         zS = pP->streamsFromDecodes[z];
2516         (void)zS; // clear compiler warning in case not used with tracing disabled
2517         if (pAstCfg->xInp[zI].hRxSio && pAstCfg->xDec[z].decodeStatus.mode)
2518         {
2519 #endif
2520             Uns gear;
2521             Int frameLength;
2522             TRACE_VERBOSE1("AS%d: PAF_ASIT_decodeInit: initializing decode", as+zS);
2524             // write back Dec configuration
2525             Cache_wb(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2526             Cache_wait();
2528             // FL: send dec activate message to slave
2529             pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize);  /* allocate message */
2530             if (pAspMsg == NULL)
2531             {
2532                 TRACE_TERSE0("MessageQ_alloc() failure.");
2533                 SW_BREAKPOINT; // temporary
2534                 return -1; // temporary
2535             }
2536             MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
2537             pAspMsg->cmd = ASP_SLAVE_DEC_ACTIVATE;                                              /* fill in message payload */
2538             pAspMsg->procId = hAspMsgMaster->masterProcId;
2539             pAspMsg->expectResp = TRUE;
2540             pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
2541             argIdx = 0; // set decIdx (zone index)
2542             *(Int32 *)&pAspMsg->buf[argIdx] = z;
2543             TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2544             TRACE_MSG1("decIdx=%d", pAspMsg->buf[0]);
2545             status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);                       /* send message */
2546             if (status != MessageQ_S_SUCCESS)
2547             {
2548                 SW_BREAKPOINT;
2549             }
2550             // wait for dec activate complete message from slave
2551             status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
2552             if (status != MessageQ_S_SUCCESS)
2553             {
2554                 TRACE_TERSE0("MessageQ_get() failure.");
2555                 SW_BREAKPOINT; // temporary
2556                 return -1; // temporary
2557             }
2558             if ((pAspMsg->procId != hAspMsgMaster->slaveProcId) || 
2559                 (pAspMsg->cmd != ASP_MASTER_DEC_ACTIVATE_DONE) ||
2560                 (pAspMsg->messageId != (hAspMsgMaster->messageId | ((UInt32)1<<31))))
2561             {
2562                 TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2563                 SW_BREAKPOINT; // temporary
2564                 return -1; // temporary
2565             }      
2566             hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
2567             TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2568             // free the message
2569             status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
2570             if (status != MessageQ_S_SUCCESS)
2571             {
2572                 SW_BREAKPOINT;
2573             }
2574             
2575 #if 0 // FL: decoder activate call, slave
2576             if (decAlg[z]->fxns->algActivate)
2577                 decAlg[z]->fxns->algActivate (decAlg[z]);
2578 #endif
2580             // FL: send dec reset message to slave
2581             pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize);  /* allocate message */
2582             if (pAspMsg == NULL)
2583             {
2584                 TRACE_TERSE0("MessageQ_alloc() failure.");
2585                 SW_BREAKPOINT; // temporary
2586                 return -1; // temporary
2587             }
2588             MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
2589             pAspMsg->cmd = ASP_SLAVE_DEC_RESET;                                                 /* fill in message payload */
2590             pAspMsg->procId = hAspMsgMaster->masterProcId;
2591             pAspMsg->expectResp = TRUE;
2592             pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
2593             argIdx = 0; // set decIdx
2594             *(Int32 *)&pAspMsg->buf[argIdx] = z;
2595             TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2596             TRACE_MSG1("decIdx=%d", pAspMsg->buf[0]);
2597             // wait for dec reset complete message from slave
2598             status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message */
2599             if (status != MessageQ_S_SUCCESS)
2600             {
2601                 SW_BREAKPOINT;
2602             }
2603             status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
2604             if (status != MessageQ_S_SUCCESS)
2605             {
2606                 TRACE_TERSE0("MessageQ_get() failure.");
2607                 SW_BREAKPOINT; // temporary
2608                 return -1; // temporary
2609             }
2610             if ((pAspMsg->procId == hAspMsgMaster->slaveProcId) &&
2611                 (pAspMsg->cmd == ASP_MASTER_DEC_RESET_DONE) && 
2612                 (pAspMsg->messageId == (hAspMsgMaster->messageId | ((UInt32)1<<31))))
2613             {
2614                 hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
2615                 TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2616                 TRACE_MSG1("decErrno=%d", pAspMsg->buf[0]);
2618                 argIdx = 0; // get decErrno
2619                 errno = *(Int32 *)&pAspMsg->buf[argIdx];
2620             }
2621             else
2622             {
2623                 //
2624                 // Invalid message received
2625                 //
2626                 TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2627                 SW_BREAKPOINT; // temporary
2628                 return -1; // temporary
2629             }
2630             // free the message
2631             status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
2632             if (status != MessageQ_S_SUCCESS)
2633             {
2634                 SW_BREAKPOINT;
2635             }
2636             
2637             // (***) FL: revisit
2638             // invalidate Dec configuration
2639             Cache_inv(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2640             Cache_wait();
2641             
2642 #if 0 // FL: decoder reset call, slave
2643             if (dec->fxns->reset
2644                 && (errno = dec->fxns->reset (dec, NULL,
2645                                               &pC->xDec[z].decodeControl, &pC->xDec[z].decodeStatus)))
2646                 return errno;
2647 #endif
2648             if (errno != 0)
2649             {
2650                 return errno;
2651             }
2652             
2653 #ifdef NON_CACHE_STATUS
2654             gear = 0;  // due to size difference
2655             statusOp_read(&gear,
2656                           &(pAstCfg->xDec[z].decodeStatus.aspGearControl),
2657                           sizeof(Int8),
2658                           GATEMP_INDEX_DEC);
2659             tempVar8 = gear < GEARS ? gear : 0;
2660             statusOp_write(&(pAstCfg->xDec[z].decodeStatus.aspGearStatus),
2661                            &tempVar8,
2662                            sizeof(tempVar8),
2663                            GATEMP_INDEX_DEC);
2664 #else
2665             gear = pAstCfg->xDec[z].decodeStatus.aspGearControl;
2666             pAstCfg->xDec[z].decodeStatus.aspGearStatus = gear < GEARS ? gear : 0;
2667 #endif
2668             
2669 #if 0 // FL: change handle to decIdx (zone index)
2670             frameLength = pP->fxns->computeFrameLength(decAlg[z], 
2671                 FRAMELENGTH,
2672                 pC->xDec[z].decodeStatus.bufferRatio);
2673 #endif
2674 #if 0 // (***) FL: revisit. Bypass computeFrameLength().
2675             frameLength = pP->fxns->computeFrameLength(z, 
2676                 FRAMELENGTH, 
2677                 pC->xDec[z].decodeStatus.bufferRatio);
2678 #else
2679             if (sourceSelect == PAF_SOURCE_PCM)
2680             {
2681                 frameLength = PAF_SYS_FRAMELENGTH;
2682             }
2683             else if ((sourceSelect == PAF_SOURCE_DDP) || (sourceSelect == PAF_SOURCE_AC3))
2684             {
2685                 frameLength = 1536;
2686             }
2687             else if (sourceSelect == PAF_SOURCE_THD)
2688             {
2689                 frameLength = 1536; //QIN FIX ME
2690             }
2691             else
2692             {
2693                 frameLength = 256;
2694             }
2695 #endif    
2696             
2697             pAstCfg->xDec[z].decodeControl.frameLength = frameLength;
2698             pAstCfg->xDec[z].decodeInStruct.sampleCount = frameLength;
2699             pAstCfg->xDec[z].decodeControl.sampleRate = PAF_SAMPLERATE_UNKNOWN;
2700             
2701             // (***) FL: revisit. Count samples for DDP.
2702             // Add framework frame length and running sample count to decoder control.
2703             //pC->xDec[z].decodeControl.pafFrameLength = FRAMELENGTH;
2704             //pC->xDec[z].decodeControl.rdSampleCount = 0;
2706             // Initialize decoder output circular buffer for selected source
2707             errno = cbInitSourceSel(pCbCtl, z, sourceSelect, frameLength, FRAMELENGTH, 0);
2708             if (errno)
2709             {
2710                 SW_BREAKPOINT; // FL: debug
2711                 return errno;
2712             }
2713             // FL: debug
2714             cbLog(pCbCtl, z, 1, "PAF_ASIT_decodeInit:cbInitSourceSel");
2715             
2716             if (z != zMD) 
2717             {
2718                 if (errno = SIO_idle(pAstCfg->xInp[zI].hRxSio))
2719                 {
2720                     return errno;
2721                 }
2722             }
2724 #ifdef NON_CACHE_STATUS
2725             statusOp_read(&tempVar8,
2726                           &(pAstCfg->xDec[z].decodeStatus.sourceSelect),
2727                           sizeof(Int8),
2728                           GATEMP_INDEX_DEC);
2729             if (errno = SIO_ctrl(pAstCfg->xInp[zI].hRxSio, PAF_SIO_CONTROL_SET_SOURCESELECT,
2730                 DECSIOMAP(tempVar8)))
2731             {
2732                 return errno;
2733             }
2734 #else
2735             if (errno = SIO_ctrl(pAstCfg->xInp[zI].hRxSio, PAF_SIO_CONTROL_SET_SOURCESELECT,
2736                 DECSIOMAP(pAstCfg->xDec[z].decodeStatus.sourceSelect)))
2737             {
2738                 return errno;
2739             }
2740 #endif
2741             if (errno = SIO_ctrl(pAstCfg->xInp[zI].hRxSio, PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, 
2742                 frameLength))
2743             {
2744                 return errno;
2745             }
2746             if (errno = pP->fxns->updateInputStatus(pAstCfg->xInp[zI].hRxSio, &pAstCfg->xInp[zI].inpBufStatus, 
2747                 &pAstCfg->xInp[zI].inpBufConfig))
2748             {
2749                 return errno;
2750             }
2751         }
2752     }
2754     if (pAstCfg->xInp[zMI].hRxSio) 
2755     {
2756         errno = SIO_issue(pAstCfg->xInp[zMI].hRxSio, &pAstCfg->xInp[zMI].inpBufConfig,
2757             sizeof(pAstCfg->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME);
2758         if (errno)
2759         {
2760             return errno;
2761         }
2762     }
2764     return 0;
2765 } //PAF_AST_decodeInit
2767 // -----------------------------------------------------------------------------
2768 // ASIT Decoding Function - Info Processing, Common
2769 //
2770 //   Name:      PAF_ASIT_decodeInfo
2771 //   Purpose:   Decoding Function for processing information in a manner that
2772 //              is common for both initial and subsequent frames of input data.
2773 //   From:      AST Parameter Function -> decodeProcessing
2774 //   Uses:      See code.
2775 //   States:    x
2776 //   Return:    Error number in standard form (0 on success).
2777 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2778 //              * State information as per parent.
2779 //
2780 Int
2781 PAF_ASIT_decodeInfo(
2782     const PAF_ASIT_Params *pP, 
2783     const PAF_ASIT_Patchs *pQ, 
2784     PAF_ASIT_Config *pC, 
2785     Int frame, 
2786     Int block
2789     PAF_AST_Config *pAstCfg;
2790     Int as;                    /* Audio Stream Number (1, 2, etc.) */
2791     Int z;                     /* input/decode/stream counter */
2792     Int errno;                 /* error number */
2793     Int sioErr;                /* error number, SIO */
2794     Int zD, zI, zS, zX;
2795     Int zMD;
2796     Int zMI;
2797     Int zMS;
2798     UInt32 curTime;
2799     ASP_Msg *pAspMsg;          /* Messaging */
2800     Int argIdx;
2801     Int status;
2802 #ifdef NON_CACHE_STATUS
2803     Int8 tempVar8;
2804     Int tempVar;
2805 #endif
2806     // FL: revisit
2807     //Int size;
2808     //PAF_InpBufConfig *pIpBufConfig;
2810     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
2811     as = pAstCfg->as;
2812     zMD = pAstCfg->masterDec;
2813     zMS = pAstCfg->masterStr;
2814     zMI = pP->zone.master;
2815     (void)zMS;  (void)as;  // clear compiler warning in case not used with tracing disabled
2816     
2817     // Set decode control: sample rate, emphasis
2818     for (z=INPUT1; z < INPUTN; z++)
2819     {
2820         zD = z;
2821         for (zX = DECODE1; zX < DECODEN; zX++) 
2822         {
2823             if (pP->inputsFromDecodes[zX] == z) 
2824             {
2825                 zD = zX;
2826                 break;
2827             }
2828         }
2829 #ifdef PROFILER
2830             // modify for different sampling rate
2831             if (pAstCfg->xInp[z].inpBufStatus.sampleRateStatus == PAF_SAMPLERATE_96000HZ)
2832             {
2833                 start_profiling = 1;
2834             }
2835             else
2836             {
2837                 start_profiling = 0;
2838             }
2839 #endif
2840         if (pAstCfg->xInp[z].hRxSio) 
2841         {
2842             //determine associated decoder
2843             if (pAstCfg->xInp[z].inpBufStatus.sampleRateStatus != 
2844                 pAstCfg->xDec[zD].decodeControl.sampleRate) 
2845             {
2846                 if (pAstCfg->xDec[zD].decodeControl.sampleRate == PAF_SAMPLERATE_UNKNOWN) 
2847                 {
2848                     pAstCfg->xDec[zD].decodeControl.sampleRate = 
2849                         pAstCfg->xInp[z].inpBufStatus.sampleRateStatus;
2850                 }
2851                 else
2852                 {
2853                     TRACE_TERSE1("AS%d: return error ASPERR_INFO_RATECHANGE", as+pAstCfg->masterStr);
2854                     TRACE_TERSE2("inpBufStatus.sampleRateStatus: 0x%x, decodeControl.sampleRate: 0x%x",
2855                         pAstCfg->xInp[z].inpBufStatus.sampleRateStatus, 
2856                         pAstCfg->xDec[zD].decodeControl.sampleRate);
2857                     // return (ASPERR_INFO_RATECHANGE);
2858                 }
2859             }
2860 #ifdef NON_CACHE_STATUS
2861             statusOp_read(&tempVar8,
2862                           &(pAstCfg->xDec[zD].decodeStatus.sourceDecode),
2863                           sizeof(Int8),
2864                           GATEMP_INDEX_DEC);
2865             pAstCfg->xDec[zD].decodeControl.emphasis = 
2866                 tempVar8 != PAF_SOURCE_PCM
2867                 ? PAF_IEC_PREEMPHASIS_NO // fix for Mantis ID #119
2868                 : pAstCfg->xInp[z].inpBufStatus.emphasisStatus;
2869 #else
2870             pAstCfg->xDec[zD].decodeControl.emphasis =
2871                 pAstCfg->xDec[zD].decodeStatus.sourceDecode != PAF_SOURCE_PCM
2872                 ? PAF_IEC_PREEMPHASIS_NO // fix for Mantis ID #119
2873                 : pAstCfg->xInp[z].inpBufStatus.emphasisStatus;
2874 #endif
2875         }
2876         else 
2877         {
2878             pAstCfg->xDec[zD].decodeControl.sampleRate = PAF_SAMPLERATE_UNKNOWN;
2879             pAstCfg->xDec[zD].decodeControl.emphasis = PAF_IEC_PREEMPHASIS_UNKNOWN;
2880         }
2881     }
2883     // Wait for info input
2884     TRACE_VERBOSE2("PAF_ASIT_decodeInfo: AS%d: awaiting frame %d -- sync+info+data", as+zMS, frame);
2885     if (pAstCfg->xInp[zMI].hRxSio) 
2886     {
2887         TRACE_VERBOSE0("PAF_ASIT_decodeInfo: call SIO_reclaim to get input buffer.");
2888         sioErr = SIO_reclaim(pAstCfg->xInp[zMI].hRxSio, (Ptr)&pAstCfg->xInp[zMI].pInpBuf, NULL);
2889         if (sioErr != sizeof(pAstCfg->xInp[zMI].inpBufConfig))
2890         {
2891             TRACE_TERSE1("SIO_reclaim on input returned error ASPERR_RECLAIM.  sioErr: 0x%x", sioErr);
2892             return ASPERR_RECLAIM;
2893         }
2894         
2895         // FL: debug, capture input buffer
2896         capIb(pAstCfg->xInp[zMI].pInpBuf);
2897         gCapIb_cnt++;
2898         
2899 #if 1 // (***) FL: shows timing of Input Rx SIO reclaim after decoding has started (autodet complete)
2900         // (***) debug // B5
2901         {
2902             static Uint8 toggleState = 0;
2903             if (toggleState == 0)
2904                 GPIOSetOutput(GPIO_PORT_0, GPIO_PIN_99);
2905             else
2906                 GPIOClearOutput(GPIO_PORT_0, GPIO_PIN_99);
2907             toggleState = ~(toggleState);
2908         }
2909 #endif
2911         //
2912         // Simulate Rx SIO_reclaim() pend
2913         //
2914         //Semaphore_pend(semaphoreRxAudio, BIOS_WAIT_FOREVER); 
2915         gTaskAsipCnt++;
2916         curTime = Clock_getTicks();
2917         //System_printf("System time in TaskAsipFxn Rx audio = %lu\n", (ULong)curTime);        
2918         //Log_info1("System time in TaskAsipFxn Rx audio = %u", curTime);
2919         //Log_info1("decodeInfo():Rx SIO reclaim(), system time = %u", curTime);
2920     } //pC->xInp[zMI].hRxSio
2922     // Decode info
2923     for (z=DECODE1; z < DECODEN; z++) 
2924     {
2925         zI = pP->inputsFromDecodes[z];
2926         zS = pP->streamsFromDecodes[z];
2927         (void)zS; // clear compiler warning in case not used with tracing disabled
2928 #ifdef NON_CACHE_STATUS
2929         statusOp_read(&tempVar8,
2930                       &(pAstCfg->xDec[z].decodeStatus.mode),
2931                       sizeof(Int8),
2932                       GATEMP_INDEX_DEC);
2933         if (pAstCfg->xInp[zI].hRxSio && tempVar8)
2934         {
2935 #else
2936         if (pAstCfg->xInp[zI].hRxSio && pAstCfg->xDec[z].decodeStatus.mode) 
2937         {
2938 #endif
2939             TRACE_GEN2("PAF_ASIT_decodeInfo: AS%d: processing frame %d -- info", as+zS, frame);
2941             if (errno = pP->fxns->updateInputStatus(pAstCfg->xInp[zI].hRxSio,
2942                 &pAstCfg->xInp[zI].inpBufStatus, &pAstCfg->xInp[zI].inpBufConfig))
2943             {
2944                 TRACE_TERSE1("return error errno 0x%x.", errno);
2945                 return errno;
2946             }
2948 #if 1
2949             // (***) FL: revisit
2950             // write back Inp configuration
2951             Cache_wb(&pAstCfg->xInp[zI], sizeof(PAF_AST_InpBuf), Cache_Type_ALLD, 0);
2952             // write back input data //  (***) GJ: don't need this for 1xI2S HDMI/SPDIF. Maybe need this for 4xI2S HDMI.
2953             //pIpBufConfig = &gPAF_AST_config.xInp[zI].inpBufConfig;
2954             //size = pIpBufConfig->frameLength * pIpBufConfig->sizeofElement;
2955             //Cache_wb((Ptr)pIpBufConfig->pntr.pSmInt, size, Cache_Type_ALLD, 0);
2956             // write back Dec configuration
2957             Cache_wb(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2958             Cache_wait();
2959 #endif
2960             
2961             // FL: send info message to slave
2962             pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize); /* allocate message */
2963             if (pAspMsg == NULL)
2964             {
2965                 TRACE_TERSE0("MessageQ_alloc() failure.");
2966                 SW_BREAKPOINT; // temporary
2967                 return -1;  // temporary
2968             }
2969             MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
2970             pAspMsg->cmd = ASP_SLAVE_DEC_INFO;                                                  /* fill in message payload */
2971             pAspMsg->procId = hAspMsgMaster->masterProcId;
2972             pAspMsg->expectResp = TRUE;
2973             pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
2974             argIdx = 0; // set decIdx
2975             *(Int32 *)&pAspMsg->buf[argIdx] = z;
2976             TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2977             TRACE_MSG1("decIdx=%d", pAspMsg->buf[0]);
2978             status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message to slave */
2979             if (status != MessageQ_S_SUCCESS)
2980             {
2981                 SW_BREAKPOINT;
2982             }
2983             // wait for dec info complete message from slave -- temporary
2984             status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
2985             if (status != MessageQ_S_SUCCESS)
2986             {
2987                 TRACE_TERSE0("MessageQ_get() failure.");
2988                 SW_BREAKPOINT;
2989                 return -1; // temporary
2990             }
2991             if ((pAspMsg->procId == hAspMsgMaster->slaveProcId) &&
2992                 (pAspMsg->cmd == ASP_MASTER_DEC_INFO_DONE) && 
2993                 (pAspMsg->messageId == (hAspMsgMaster->messageId | ((UInt32)1<<31))))
2994             {
2995                 hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
2996                 TRACE_TERSE3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2997                 TRACE_MSG1("decErrno=%d", pAspMsg->buf[0]);
2998                 
2999                 argIdx = 0; // get decErrno
3000                 errno = *(Int32 *)&pAspMsg->buf[argIdx];
3001             }
3002             else
3003             {
3004                 //
3005                 // Invalid message received
3006                 //
3007                 TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
3008                 SW_BREAKPOINT; // temporary
3009                 return -1; // temporary
3010             }
3011             // free the message
3012             status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
3013             if (status != MessageQ_S_SUCCESS)
3014             {
3015                 SW_BREAKPOINT;
3016             }
3018 #if 1
3019             // (***) FL: revisit
3020             // invalidate Dec configuration
3021             Cache_inv(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
3022             Cache_wait();                            
3023 #endif            
3024             
3025 #if 0 // FL: decoder info call, slave
3026             if (dec->fxns->info
3027                 && (errno = dec->fxns->info (dec, NULL,
3028                                              &pC->xDec[z].decodeControl, &pC->xDec[z].decodeStatus))) 
3029 #endif
3030             if (errno)
3031             {
3032                 TRACE_TERSE1("return error errno 0x%x.", errno);
3033                 return errno;
3034             }
3036 #ifdef NON_CACHE_STATUS
3037             statusOp_read(&tempVar,
3038                           &(pAstCfg->xDec[z].decodeStatus.frameCount),
3039                           sizeof(Int),
3040                           GATEMP_INDEX_DEC);
3041             // increment decoded frame count
3042             tempVar += 1;
3043             statusOp_write(&(pAstCfg->xDec[z].decodeStatus.frameCount),
3044                            &tempVar,
3045                            sizeof(Int),
3046                            GATEMP_INDEX_DEC);
3047 #else
3048             // increment decoded frame count
3049             pAstCfg->xDec[z].decodeStatus.frameCount += 1;
3050 #endif
3051         }
3052     } // z=DECODE1 to DECODEN
3054 #ifdef NON_CACHE_STATUS
3055     statusOp_read(&tempVar8,
3056                   &(pAstCfg->xDec[zMD].decodeStatus.mode),
3057                   sizeof(Int8),
3058                   GATEMP_INDEX_DEC);
3059     // query IB for latest sourceProgram (needed if we started decoding due to a force mode)
3060     if (tempVar8)
3061     {
3062         XDAS_Int8 sourceProgram;
3063         if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_SOURCEPROGRAM,
3064             (Arg)&sourceProgram))
3065         {
3066             TRACE_TERSE1("return error ASPERR_AUTO_PROGRAM. errno 0x%x.", errno);
3067             return ASPERR_AUTO_PROGRAM;
3068         }
3069         statusOp_write(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram),
3070                        &(sourceProgram),
3071                        sizeof(Int8),
3072                        GATEMP_INDEX_DEC);
3073     }
3075     // since now decoding update decode status for all enabled decoders
3076     for (z=DECODE1; z < DECODEN; z++)
3077     {
3078         statusOp_read(&tempVar8,
3079                       &(pAstCfg->xDec[z].decodeStatus.mode),
3080                       sizeof(Int8),
3081                       GATEMP_INDEX_DEC);
3082         if (tempVar8)
3083         {
3084             statusOp_read(&tempVar8,
3085                           &(pAstCfg->xDec[z].decodeStatus.sourceProgram),
3086                           sizeof(Int8),
3087                           GATEMP_INDEX_DEC);
3088             statusOp_write(&(pAstCfg->xDec[z].decodeStatus.sourceDecode),
3089                            &tempVar8,
3090                            sizeof(Int8),
3091                            GATEMP_INDEX_DEC);
3092             statusOp_read(&tempVar8,
3093                           &(pAstCfg->xDec[z].decodeStatus.sourceSelect),
3094                           sizeof(Int8),
3095                           GATEMP_INDEX_DEC);
3096             if (tempVar8 == PAF_SOURCE_SNG)
3097             {
3098                 tempVar8 = PAF_SOURCE_SNG;
3099                 statusOp_write(&(pAstCfg->xDec[z].decodeStatus.sourceDecode),
3100                                &tempVar8,
3101                                sizeof(Int8),
3102                                GATEMP_INDEX_DEC);
3103             }
3104         }
3105     }
3106 #else
3107     // query IB for latest sourceProgram (needed if we started decoding due to a force mode)
3108     if (pAstCfg->xDec[zMD].decodeStatus.mode) 
3109     {
3110         XDAS_Int8 sourceProgram;
3111         if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_SOURCEPROGRAM,
3112             (Arg)&sourceProgram))
3113         {
3114             TRACE_TERSE1("return error ASPERR_AUTO_PROGRAM. errno 0x%x.", errno);
3115             return ASPERR_AUTO_PROGRAM;
3116         }
3117         pAstCfg->xDec[zMD].decodeStatus.sourceProgram = sourceProgram;
3118     }
3120     // since now decoding update decode status for all enabled decoders
3121     for (z=DECODE1; z < DECODEN; z++) 
3122     {
3123         if (pAstCfg->xDec[z].decodeStatus.mode) 
3124         {
3125             pAstCfg->xDec[z].decodeStatus.sourceDecode = pAstCfg->xDec[z].decodeStatus.sourceProgram;
3126             if (pAstCfg->xDec[z].decodeStatus.sourceSelect == PAF_SOURCE_SNG)
3127             {
3128                 pAstCfg->xDec[z].decodeStatus.sourceDecode = PAF_SOURCE_SNG;
3129             }
3130         }
3131     }
3132 #endif
3134 #if 0 // FL: ASDT (slave)
3135     // TODO: move this to start of this function so that it doesn't affect IO timing
3136     // Initialize audio frame(s)
3137     //    Re-initialize audio frame if there is an associated decode and
3138     //    that decode doesn't have a valid input or is turned off
3139     for (z=STREAM1; z < STREAMN; z++) 
3140     {
3141         Int reset = 0;
3142         for (zX = DECODE1; zX < DECODEN; zX++) 
3143         {
3144             if (pP->streamsFromDecodes[zX] == z) 
3145             {
3146                 zI = pP->inputsFromDecodes[zX];
3147                 if (!pC->xDec[zX].decodeStatus.mode || !pC->xInp[zI].hRxSio)
3148                 {
3149                     reset = 1;
3150                 }
3151             }
3152         }
3153         if (reset) 
3154         {
3155             TRACE_VERBOSE2("PAF_ASIT_decodeInfo: AS%d: initializing block %d -- info", as+z, frame);
3156             pP->fxns->initFrame1 (pP, pQ, pC, z, 0);
3157         }
3158         else
3159         {
3160             TRACE_VERBOSE2("PAF_ASIT_decodeInfo: AS%d: initializing block %d -- info <ignored>", as+z, frame);
3161         }
3162     }
3163 #endif    
3165     return 0;
3166 } //PAF_ASIT_decodeInfo
3168 // -----------------------------------------------------------------------------
3169 // ASIT Decoding Function - Info Processing, Initial
3170 //
3171 //   Name:      PAF_ASIT_decodeInfo1
3172 //   Purpose:   Decoding Function for processing information in a manner that
3173 //              is unique to initial frames of input data.
3174 //   From:      AST Parameter Function -> decodeProcessing
3175 //   Uses:      See code.
3176 //   States:    x
3177 //   Return:    Error number in standard or SIO form (0 on success).
3178 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
3179 //              * State information as per parent.
3180 //
3181 Int
3182 PAF_ASIT_decodeInfo1(
3183     const PAF_ASIT_Params *pP, 
3184     const PAF_ASIT_Patchs *pQ, 
3185     PAF_ASIT_Config *pC, 
3186     Int frame, 
3187     Int block
3190     return 0;
3191 } //PAF_ASIT_decodeInfo1
3193 // -----------------------------------------------------------------------------
3194 // AST Decoding Function - Info Processing, Subsequent
3195 //
3196 //   Name:      PAF_AST_decodeInfo2
3197 //   Purpose:   Decoding Function for processing information in a manner that
3198 //              is unique to frames of input data other than the initial one.
3199 //   From:      AST Parameter Function -> decodeProcessing
3200 //   Uses:      See code.
3201 //   States:    x
3202 //   Return:    Error number in standard form (0 on success).
3203 //   Trace:     None.
3204 //
3205 Int
3206 PAF_ASIT_decodeInfo2(
3207     const PAF_ASIT_Params *pP, 
3208     const PAF_ASIT_Patchs *pQ, 
3209     PAF_ASIT_Config *pC, 
3210     Int frame, 
3211     Int block
3214     return 0;
3215 } //PAF_ASIT_decodeInfo2
3217 // -----------------------------------------------------------------------------
3218 // AST Decoding Function - Continuation Processing
3219 //
3220 //   Name:      PAF_AST_decodeCont
3221 //   Purpose:   Decoding Function for processing that occurs subsequent to
3222 //              information processing but antecedent to timing processing
3223 //              for frames of input data other than the initial one.
3224 //   From:      AST Parameter Function -> decodeProcessing
3225 //   Uses:      See code.
3226 //   States:    x
3227 //   Return:    Error number in standard form (0 on success).
3228 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
3229 //              * State information as per parent.
3230 //
3232 Int
3233 PAF_AST_decodeCont(
3234     const PAF_ASIT_Params *pP, 
3235     const PAF_ASIT_Patchs *pQ, 
3236     PAF_ASIT_Config *pC, 
3237     ALG_Handle decAlg[], 
3238     Int frame, 
3239     Int block
3242     PAF_AST_Config *pAstCfg;
3243     Int as;                     /* Audio Stream Number (1, 2, etc.) */
3244     Int z;                      /* decode counter */
3245     Int zI, zS;
3246     Int zMD;
3247 #ifdef NON_CACHE_STATUS
3248     Int8 tempVar8;
3249 #endif
3251     
3252     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
3253     as = pAstCfg->as;
3254     zMD = pAstCfg->masterDec;
3255     (void)as;  // clear compiler warning in case not used with tracing disabled
3256     
3257     // Await slave inputs
3258     for (z=DECODE1; z < DECODEN; z++)
3259     {
3260         zI = pP->inputsFromDecodes[z];
3261         zS = pP->streamsFromDecodes[z];
3262         (void)zS;
3263 #ifdef NON_CACHE_STATUS
3264         statusOp_read(&tempVar8,
3265                       &(pAstCfg->xDec[z].decodeStatus.mode),
3266                       sizeof(Int8),
3267                       GATEMP_INDEX_DEC);
3268         if (z == zMD
3269             || ! pAstCfg->xInp[zI].hRxSio
3270             || ! tempVar8)
3271             continue;
3272 #else
3273         if (z == zMD
3274             || ! pAstCfg->xInp[zI].hRxSio
3275             || ! pAstCfg->xDec[z].decodeStatus.mode)
3276             continue;
3277 #endif
3278         TRACE_VERBOSE2("PAF_AST_decodeCont: AS%d: awaiting frame %d -- data", as+zS, frame);
3279         if (SIO_reclaim(pAstCfg->xInp[zI].hRxSio, (Ptr)&pAstCfg->xInp[zI].pInpBuf, NULL)
3280             != sizeof (pAstCfg->xInp[zI].inpBufConfig))
3281             return (ASPERR_RECLAIM);
3282     }
3284     return 0;
3285 } //PAF_AST_decodeCont
3287 // -----------------------------------------------------------------------------
3288 // ASIT Decoding Function - Decode Processing
3289 //
3290 //   Name:      PAF_ASIT_decodeDecode
3291 //   Purpose:   Decoding Function for processing of input data by the
3292 //              Decode Algorithm.
3293 //   From:      AST Parameter Function -> decodeProcessing
3294 //   Uses:      See code.
3295 //   States:    x
3296 //   Return:    Error number in standard form (0 on success).
3297 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
3298 //              * State information as per parent.
3299 //
3300 Int
3301 PAF_ASIT_decodeDecode(
3302     const PAF_ASIT_Params *pP, 
3303     const PAF_ASIT_Patchs *pQ, 
3304     PAF_ASIT_Config *pC, 
3305     Int sourceSelect, 
3306     Int frame, 
3307     Int block
3310     PAF_AST_Config *pAstCfg;
3311     Int as;                     /* Audio Stream Number (1, 2, etc.) */
3312     Int z;