Cleaned up system stream.
[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         // Measure cycles in autodet processing loop.
764         // Only measures cycles spent in loop.
765         pfpEnd(PFP_ID_ASIT_0, PFP_FINISH_MEAS);      // PFP end
766         pfpBegin(PFP_ID_ASIT_0, pC->taskHandle);     // PFP begin
768         statusOp_read(&tempVar8,
769                       &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
770                       sizeof(tempVar8),
771                       GATEMP_INDEX_DEC);
772         // .....................................................................
773         // At this point we have an enabled input and want to decode something.
774         // If no decoder selected then do nothing. Need to reset the sourceProgram, since
775         // when no decoder is selected there are no calls to IB
776         //if (errno = pP->fxns->autoProcessing(pP, pQ, pC, pC->xDec[zMD].decodeStatus.sourceSelect, pC->xDec[zMD].decAlg[PAF_SOURCE_PCM]))
777         if (errno = pP->fxns->autoProcessing(pP, pQ, pC, tempVar8, NULL)) // (***) FL: re-visit this, hard-coded to use PCM framelength inside function
778         {
779             TRACE_VERBOSE1("TaskAsip: autoProcessing returns 0x%x, continue", errno);
780             continue;
781         }
782 #else
783         // .....................................................................
784         // At this point we have an enabled input and want to decode something.
785         // If no decoder selected then do nothing. Need to reset the sourceProgram, since
786         // when no decoder is selected there are no calls to IB
787         //if (errno = pP->fxns->autoProcessing(pP, pQ, pC, pC->xDec[zMD].decodeStatus.sourceSelect, pC->xDec[zMD].decAlg[PAF_SOURCE_PCM]))
788         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
789         {
790             TRACE_VERBOSE1("TaskAsip: autoProcessing returns 0x%x, continue", errno);
791             continue;
792         }
793 #endif
794         
795         pfpEnd(PFP_ID_ASIT_0, PFP_FINISH_MEAS);      // PFP end -- outside of PFP for autodetection complete
796         
797         // query for input type
798         if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_SOURCEPROGRAM, (Arg )&sourceProgram))
799         {
800             TRACE_TERSE2("TaskAsip: SIO_ctrl returns 0x%x, then 0x%x, continue", errno, ASPERR_AUTO_PROGRAM);
801             errno = ASPERR_AUTO_PROGRAM;
802             continue;
803         }
804 #ifdef NON_CACHE_STATUS
805         statusOp_write(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram),
806                       &(sourceProgram),
807                       sizeof(sourceProgram),
808                       GATEMP_INDEX_DEC);
809 #else
810         pAstCfg->xDec[zMD].decodeStatus.sourceProgram = sourceProgram;
811 #endif
813         // if input is unclassifiable then do nothing
814         if (sourceProgram == PAF_SOURCE_UNKNOWN)
815         {
816             TRACE_VERBOSE0("TaskAsip: Source program unknown. continue");
817             continue;
818         }
820         // now that we have some input classification, and possibly an outstanding
821         // input frame, we determine whether or not to call decodeProcessing and with
822         // what decAlg.
823         sourceSelect = PAF_SOURCE_NONE;
824 #ifdef NON_CACHE_STATUS
825         statusOp_read(&tempVar8,
826                       &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
827                       sizeof(tempVar8),
828                       GATEMP_INDEX_DEC);
829         switch (tempVar8)
830         {
831 #else
832         switch (pAstCfg->xDec[zMD].decodeStatus.sourceSelect) 
833         {
834 #endif
835             // If autodetecting, decoding everything, and input is something
836             // (i.e. bitstream or PCM) then decode.
837             case PAF_SOURCE_AUTO:
838                 if (sourceProgram >= PAF_SOURCE_PCM)
839                 {
840                     sourceSelect = sourceProgram;                    
841                 }
842                 break;
844             // If autodetecting, decoding only PCM, and input is PCM then decode.
845             case PAF_SOURCE_PCMAUTO:
846                 if (sourceProgram == PAF_SOURCE_PCM)
847                 {
848                     sourceSelect = sourceProgram;                    
849                 }
850                 break;
852             // If autodetecting, decoding only bitstreams, and input is a bitstream then decode.
853             case PAF_SOURCE_BITSTREAM:
854                 if (sourceProgram >= PAF_SOURCE_AC3)
855                 {
856                     sourceSelect = sourceProgram;                    
857                 }
858                 break;
860             // If autodetecting, decoding only DTS, and input is DTS then decode.
861             case PAF_SOURCE_DTSALL:
862                 switch (sourceProgram) 
863                 {
864                     case PAF_SOURCE_DTS11:
865                     case PAF_SOURCE_DTS12:
866                     case PAF_SOURCE_DTS13:
867                     case PAF_SOURCE_DTS14:
868                     case PAF_SOURCE_DTS16:
869                     case PAF_SOURCE_DTSHD:
870                         sourceSelect = sourceProgram;
871                         break;
872                 }
873                 break;
875             // All others, e.g., force modes, fall through to here.
876             // If user made specific selection then program must match select.
877             // (NB: this compare relies on ordering of PAF_SOURCE)
878             default:
879 #ifdef NON_CACHE_STATUS
880                 sourceSelect = 0; // due to size difference
881                 statusOp_read(&sourceSelect,
882                               &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
883                               sizeof(Int8),
884                               GATEMP_INDEX_DEC);
885 #else
886                 sourceSelect = pAstCfg->xDec[zMD].decodeStatus.sourceSelect;
887 #endif
888                 if ((sourceSelect >= PAF_SOURCE_PCM) && (sourceSelect <= PAF_SOURCE_N))
889                 {
890                     if (sourceProgram != sourceSelect)
891                     {
892                         sourceSelect = PAF_SOURCE_NONE;                        
893                     }
894                 }
895                 break;
896         }
898         // if we didn't find any matches then skip
899         if (sourceSelect == PAF_SOURCE_NONE)
900         {
901             TRACE_VERBOSE0("TaskAsip: no matching source type, continue");
902             continue;
903         }
905         // FL: debug, reset IB capture buffer
906         capIbReset();
907         gCapIbReset_cnt++;
908         Log_info0("capIbReset()");
910         // FL: send source select message to slave
911         pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize); /* allocate message */
912         MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
913         pAspMsg->cmd = ASP_SLAVE_DEC_SOURCE_SELECT;                                         /* fill in message payload */
914         pAspMsg->procId = hAspMsgMaster->masterProcId;
915         pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
916         pAspMsg->expectResp = TRUE;
917         *(Int32 *)&pAspMsg->buf[0] = sourceSelect;
918         TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
919         TRACE_MSG1("sourceSelect=%d", pAspMsg->buf[0]);
920         status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message */
921         if (status != MessageQ_S_SUCCESS)
922         {
923             SW_BREAKPOINT;
924         }
925         // wait for source select complete message from slave
926         //do {
927         //    status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
928         //} while (status != MessageQ_S_SUCCESS);
929         status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
930         if (status != MessageQ_S_SUCCESS)
931         {
932             TRACE_TERSE0("MessageQ_get() failure.");
933             SW_BREAKPOINT; // temporary
934         }
935         if ((pAspMsg->procId != hAspMsgMaster->slaveProcId) ||
936             (pAspMsg->cmd != ASP_MASTER_DEC_SOURCE_SELECT_DONE) ||
937             (pAspMsg->messageId != (hAspMsgMaster->messageId | ((UInt32)1<<31))))
938         {
939             TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
940             SW_BREAKPOINT;
941         }
942         hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
943         TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
944         status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
945         if (status != MessageQ_S_SUCCESS)
946         {
947             SW_BREAKPOINT;
948         }
949         
950         // set to unknown so that we can ensure, for IOS purposes, that sourceDecode = NONE
951         // iff we are in this top level state machine and specifically not in decodeProcessing
952         pP->fxns->sourceDecode(pP, pQ, pC, PAF_SOURCE_UNKNOWN);
953         
954         TRACE_VERBOSE1(procName[sourceProgram], as+zMS);
956         // Reduce priority level since autodetection complete
957         Task_setPri(pC->taskHandle, Task_getPri(pC->taskHandle)-1);
958         
959         gAspProfileEnable=1; // enable ASP profiling
960         
961         TRACE_VERBOSE0("TaskAsip: calling decodeProcessing.");
962         errno = pP->fxns->decodeProcessing(pP, pQ, pC, sourceSelect);
963         if (errno) 
964         {
965             TRACE_TERSE1("TaskAsip: decodeProcessing returns 0x%x, continue", errno);
966         }
967         else
968         {
969             TRACE_VERBOSE0("TaskAsip: decodeProcessing complete with no error.");
970         }        
972         gAspProfileEnable=0; // disable ASP profiling
973         
974         // Increase priority level since decoding complete
975         Task_setPri(pC->taskHandle, Task_getPri(pC->taskHandle)+1);
977         // FL: send dec exit message to slave
978         pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize); /* allocate message */
979         MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
980         pAspMsg->cmd = ASP_SLAVE_DEC_EXIT;                                                  /* fill in message payload */
981         pAspMsg->procId = hAspMsgMaster->masterProcId;
982         pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
983         pAspMsg->expectResp = TRUE;
984         TRACE_MSG2("Tx ASP message: procId=%d, cmd=%d.", pAspMsg->procId, pAspMsg->cmd);
985         status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message */
986         if (status != MessageQ_S_SUCCESS)
987         {
988             SW_BREAKPOINT;
989         }
990         // wait for dec exit complete message from slave
991         //do {
992         //    status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
993         //} while ((status < 0) || (pAspMsg->cmd != ASP_MASTER_DEC_EXIT_DONE));
994         status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
995         if (status != MessageQ_S_SUCCESS)
996         {
997             TRACE_TERSE0("MessageQ_get() failure.");
998             SW_BREAKPOINT; // temporary
999         }
1000         if ((pAspMsg->procId != hAspMsgMaster->slaveProcId) || 
1001             (pAspMsg->cmd != ASP_MASTER_DEC_EXIT_DONE) ||
1002             (pAspMsg->messageId != (hAspMsgMaster->messageId | ((UInt32)1<<31))))
1003         {
1004             TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
1005             SW_BREAKPOINT;
1006         }
1007         hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
1008         TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
1009         // free the message
1010         status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
1011         if (status != MessageQ_S_SUCCESS)
1012         {
1013             SW_BREAKPOINT;
1014         }
1015     } // End of main processing loop for (;;)
1016     
1017     Log_info0("Exit taskAsipFxn()");
1020 // -----------------------------------------------------------------------------
1021 // ASIT Initialization Function - Memory Allocation
1022 //
1023 //   Name:      PAF_ASIT_initPhaseMalloc
1024 //   Purpose:   Audio Stream Input Task Function for initialization of data pointers
1025 //              by allocation of memory.
1026 //   From:      audioStream1Task or equivalent
1027 //   Uses:      See code.
1028 //   States:    x
1029 //   Return:    0 on success.
1030 //              Source code line number on MEM_calloc failure.
1031 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1032 //              * State information as per parent.
1033 //              * Memory allocation errors.
1034 //
1035 Int
1036 PAF_ASIT_initPhaseMalloc(
1037     const PAF_ASIT_Params *pP, 
1038     const PAF_ASIT_Patchs *pQ, 
1039     PAF_ASIT_Config *pC
1042     PAF_AST_Config *pAstCfg;
1043     Int as;                    /* Audio Stream Number (1, 2, etc.) */
1044     Int zMS;
1045     Error_Block    eb;
1047     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1048     as = pAstCfg->as;
1049     zMS = pAstCfg->masterStr;
1050     
1051     TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: initialization phase - memory allocation", as+zMS);
1053     // Initialize error block
1054     Error_init(&eb); 
1056     /* Input memory */
1057     if (!(pAstCfg->xInp = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, 
1058         INPUTN * sizeof (*pAstCfg->xInp), 4, &eb)))
1059     {
1060         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
1061         SW_BREAKPOINT;
1062         return __LINE__;
1063     }
1064     TRACE_TERSE3("PAF_ASIT_initPhaseMalloc. (pC->xInp) %d bytes from space %d at 0x%x.",
1065         INPUTN * sizeof (*pAstCfg->xInp),
1066         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xInp);
1068 #ifdef NON_CACHE_STATUS
1069     /* Decode memory */
1070     if (!(pAstCfg->xDec = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM,
1071         DECODEN * sizeof (*pAstCfg->xDec), 4, &eb)))
1072     {
1073         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
1074         SW_BREAKPOINT;
1075         return __LINE__;
1076     }
1077 #else
1078     /* Decode memory */
1079     if (!(pAstCfg->xDec = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, 
1080         DECODEN * sizeof (*pAstCfg->xDec), 4, &eb)))
1081     {
1082         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
1083         SW_BREAKPOINT;
1084         return __LINE__;
1085     }
1086 #endif
1087     TRACE_TERSE3("PAF_ASIT_initPhaseMalloc. (pC->xDec) %d bytes from space %d at 0x%x.",
1088         DECODEN * sizeof (*pAstCfg->xDec),
1089         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xDec);
1090                 
1091     TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: initialization phase - memory allocation complete.", as+zMS);
1092     return 0;
1093 } //PAF_ASIT_initPhaseMalloc
1095 // -----------------------------------------------------------------------------
1096 // ASIT Initialization Function - Memory Initialization from Configuration
1097 //
1098 //   Name:      PAF_ASIT_initPhaseConfig
1099 //   Purpose:   Audio Stream Task Function for initialization of data values
1100 //              from parameters.
1101 //   From:      audioStream1Task or equivalent
1102 //   Uses:      See code.
1103 //   States:    x
1104 //   Return:    0 on success.
1105 //              Other as per initFrame0 and initFrame1.
1106 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1107 //              * State information as per parent.
1108 //
1109 Int
1110 PAF_ASIT_initPhaseConfig(
1111     const PAF_ASIT_Params *pP, 
1112     const PAF_ASIT_Patchs *pQ, 
1113     PAF_ASIT_Config *pC
1116     PAF_AST_Config *pAstCfg;
1117     Int as;                    /* Audio Stream Number (1, 2, etc.) */
1118     Int z;                     /* input/encode/stream/decode/output counter */
1119     Int zMS;
1121     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1122     as = pAstCfg->as;
1123     zMS = pAstCfg->masterStr;
1124     
1125     TRACE_TERSE1("PAF_ASIT_initPhaseConfig: AS%d: initialization phase - configuration", as+zMS);
1127     //
1128     // Unspecified elements have been initialized to zero during alloc
1129     //
1130     
1131     for (z=INPUT1; z < INPUTN; z++) 
1132     {
1133         pAstCfg->xInp[z].inpBufStatus = *pP->pInpBufStatus;
1134         pAstCfg->xInp[z].inpBufConfig.pBufStatus = &pAstCfg->xInp[z].inpBufStatus;
1135     }
1137     for (z=DECODE1; z < DECODEN; z++) 
1138     {
1139         Int zI = pP->inputsFromDecodes[z];
1140         pAstCfg->xDec[z].decodeControl.size = sizeof(pAstCfg->xDec[z].decodeControl);
1141         pAstCfg->xDec[z].decodeControl.pInpBufConfig = (const PAF_InpBufConfig *)&pAstCfg->xInp[zI].inpBufConfig;
1142         //pC->xDec[z].decodeStatus = *pP->z_pDecodeStatus[z]; // FL: slave
1143     }
1145     TRACE_TERSE1("PAF_ASIT_initPhaseConfig: AS%d: initialization phase - configuration complete.", as+zMS);
1146     return 0;
1147 } //PAF_ASIT_initPhaseConfig
1149 // -----------------------------------------------------------------------------
1150 // ASIT Initialization Function - ACP Algorithm Instantiation
1151 //
1152 //   Name:      PAF_ASIT_initPhaseAcpAlg
1153 //   Purpose:   Audio Stream Input Task Function for initialization of ACP by
1154 //              instantiation of the algorithm.
1155 //   From:      audioStream1Task or equivalent
1156 //   Uses:      See code.
1157 //   States:    x
1158 //   Return:    0 on success.
1159 //              Source code line number on ACP Algorithm creation failure.
1160 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1161 //              * State information as per parent.
1162 //              * Memory allocation errors.
1163 //
1164 Int
1165 PAF_ASIT_initPhaseAcpAlg(
1166     const PAF_ASIT_Params *pP, 
1167     const PAF_ASIT_Patchs *pQ, 
1168     PAF_ASIT_Config *pC
1171     PAF_AST_Config *pAstCfg;
1172     Int as;                 /* Audio Stream Number (1, 2, etc.) */
1173     Int z;                  /* input/encode/stream/decode/output counter */
1174     Int betaPrimeOffset;
1175     ACP_Handle acp;
1176     Int zMS;
1177     Int zS, zX;
1179     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1180     as = pAstCfg->as;
1181     zMS = pAstCfg->masterStr;
1182     
1183     TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: initialization phase - ACP Algorithm", as+zMS);
1185     ACP_MDS_init();
1187     if (!(acp = (ACP_Handle)ACP_MDS_create(NULL))) 
1188     {
1189         TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: ACP algorithm instance creation failed", as+zMS);
1190         return __LINE__;
1191     }
1192     pC->acp = acp;
1194     ((ALG_Handle)acp)->fxns->algControl((ALG_Handle) acp,
1195         ACP_GETBETAPRIMEOFFSET, (IALG_Status *)&betaPrimeOffset);
1197     for (z=INPUT1; z < INPUTN; z++) 
1198     {
1199         zS = z;
1200         for (zX = DECODE1; zX < DECODEN; zX++) 
1201         {
1202             if (pP->inputsFromDecodes[zX] == z) 
1203             {
1204                 zS = pP->streamsFromDecodes[zX];
1205                 break;
1206             }
1207         }
1208         acp->fxns->attach(acp, ACP_SERIES_STD,
1209             STD_BETA_IB + betaPrimeOffset * (as-1+zS),
1210             (IALG_Status *)&pAstCfg->xInp[z].inpBufStatus);
1211         /* Ignore errors, not reported. */
1212     }
1214     TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: initialization phase - ACP Algorithm complete.", as+zMS);
1216     return 0;
1217 } //PAF_ASIT_initPhaseAcpAlg
1219 // -----------------------------------------------------------------------------
1220 // ASIT Initialization Function - Common Memory
1221 //
1222 //   Name:      PAF_ASIT_initPhaseCommon
1223 //   Purpose:   Audio Stream Input Task Function for allocation of common memory.
1224 //   From:      audioStream1Task or equivalent
1225 //   Uses:      See code.
1226 //   States:    x
1227 //   Return:    0 on success.
1228 //              Source code line number on PAF_ALG_alloc failure.
1229 //              Source code line number on PAF_ALG_mallocMemory failure.
1230 //              Source code line number on Decode Chain initialization failure.
1231 //              Source code line number on ASP Chain initialization failure.
1232 //              Source code line number on Encode Chain initialization failure.
1233 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1234 //              * State information as per parent.
1235 //              * Memory allocation errors.
1236 //
1237 Int
1238 PAF_ASIT_initPhaseCommon(
1239     const PAF_ASIT_Params *pP, 
1240     const PAF_ASIT_Patchs *pQ, 
1241     PAF_ASIT_Config *pC
1244     PAF_AST_Config *pAstCfg;
1245     Int as;                     /* Audio Stream Number (1, 2, etc.) */
1246     Int z;                      /* stream counter */
1247     ACP_Handle acp;
1248     PAF_IALG_Config pafAlgConfig;
1249     IALG_MemRec common[3][PAF_IALG_COMMON_MEMN+1];
1250    
1251     acp = pC->acp;
1252     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1253     as = pAstCfg->as;
1254     
1255     TRACE_TERSE0("PAF_ASIT_initPhaseCommon: initialization phase - Common Memory");
1257     //
1258     // Determine memory needs and instantiate algorithms across audio streams
1259     //
1260     TRACE_TERSE0("PAF_ASIT_initPhaseCommon: calling PAF_ALG_setup.");
1261     PAF_ALG_setup(&pafAlgConfig, 
1262         HEAP_ID_INTERNAL,               HEAP_INTERNAL, 
1263         HEAP_ID_INTERNAL1,              HEAP_INTERNAL1, 
1264         HEAP_ID_EXTERNAL,               HEAP_EXTERNAL, 
1265         HEAP_ID_INTERNAL1_SHM,          HEAP_INTERNAL1_SHM, 
1266         HEAP_ID_EXTERNAL_SHM,           HEAP_EXTERNAL_SHM, 
1267         HEAP_ID_EXTERNAL_NONCACHED_SHM, HEAP_EXTERNAL_NONCACHED_SHM,
1268         HEAP_CLEAR);
1270     if (pP->fxns->headerPrint)
1271     {
1272         pP->fxns->headerPrint();        
1273     }
1275     for (z = STREAM1; z < STREAMN; z++) 
1276     {
1277         TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: initialization phase - Common Memory", as+z);
1279         //
1280         // Determine common memory for:
1281         //  (1) Logical Input drivers
1282         //
1283         // Decode Algorithms common memory determined in ASP Slave.
1284         //
1285         PAF_ALG_init(common[z], lengthof(common[z]), COMMONSPACE);
1287         //
1288         // Determine common memory needs of Logical Input driver
1289         //
1291         // really need to loop over all inputs for this stream using the tables
1292         // inputsFromDecodes and streamsFromDecodes. But these don't exist for this
1293         // patch, and not needed for FS11, since there is only one input.
1294         if (INPUT1 <= z && z < INPUTN) 
1295         {
1296             TRACE_TERSE2("PAF_ASIT_initPhaseCommon: AS%d: alloc inpLinkInit common[%d]", as+z, z);
1297             if (PAF_ALG_ALLOC(inpLinkInit[z-INPUT1], common[z]))
1298             {
1299                 TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: PAF_ALG_alloc failed", as+z);
1300                 TRACE_TERSE2("failed to alloc %d bytes from space %d", common[z]->size, (IArg)common[z]->space);
1301                 SW_BREAKPOINT;
1302                 return __LINE__;
1303             }
1304             TRACE_TERSE3("alloced %d bytes from space %d at 0x%x", common[z]->size, common[z]->space, (IArg)common[z]->base);
1305             if (pP->fxns->allocPrint)
1306             {
1307                 pP->fxns->allocPrint((const PAF_ALG_AllocInit *)(inpLinkInit[z-INPUT1]), sizeof (*(inpLinkInit[z-INPUT1])), &pafAlgConfig);
1308             }
1309         }
1310     }
1311     {
1312         // Changes made to share scratch between zones
1313         // Assume maximum 3 zones and scratch common memory is at offset 0;
1314         int max=0;
1315         for (z=STREAM1; z<STREAMN; z++)
1316         {
1317             if (max < common[z][0].size)
1318             {
1319                 max = common[z][0].size;
1320             }
1321         }
1322         common[STREAM1][0].size=max;
1323         for (z=STREAM1+1; z<STREAMN; z++)
1324         {
1325             common[z][0].size = 0;            
1326         }
1327     }
1328         
1329     //
1330     // Allocate common memory for:
1331     //  (1) Logical Input drivers
1332     //
1333     for (z = STREAM1; z < STREAMN; z++) 
1334     {
1335         TRACE_TERSE0("PAF_ASIT_initPhaseCommon: calling PAF_ALG_mallocMemory for common space.");
1336         if (PAF_ALG_mallocMemory(common[z], &pafAlgConfig)) 
1337         {
1338             TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: PAF_ALG_mallocMemory failed", as+z);
1339             TRACE_TERSE3("AS%d: z: %d.  Size 0x%x", as+z, z, common[z][0].size);
1340             SW_BREAKPOINT;
1341             return __LINE__;
1342         }
1343         TRACE_TERSE3("alloced %d bytes from space %d at 0x%x", common[z]->size, common[z]->space, (IArg)common[z]->base);
1344         // share zone0 scratch with all zones 
1345         common[z][0].base = common[0][0].base;
1346         if (pP->fxns->commonPrint)
1347         {
1348             pP->fxns->commonPrint(common[z], &pafAlgConfig);
1349         }
1351         //
1352         // Allocate non-common memories for Logical IO drivers
1353         //    Since these structures are used at run-time we allocate from external memory
1354         if (INPUT1 <= z && z < INPUTN) 
1355         {
1356             PAF_ASP_Chain *chain;
1357             TRACE_TERSE2("PAF_ASIT_initPhaseCommon: AS%d: non-common input chain init for %d",
1358                            as+z, z);
1359             chain = PAF_ASP_chainInit(&pAstCfg->xInp[z].inpChainData, pP->pChainFxns,
1360                         HEAP_EXTERNAL, as+z, acp, &trace,
1361                         inpLinkInit[z-INPUT1], NULL, common[z], &pafAlgConfig);
1362             if (!chain) 
1363             {
1364                 TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: Input chain initialization failed", as+z);
1365                 return __LINE__;
1366             }
1367         }
1368     }
1369     TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: Returning complete.", as+z);
1371     return 0;
1372 } //PAF_ASIT_initPhaseCommon
1374 // (***) FL: candidate for removal
1375 // -----------------------------------------------------------------------------
1376 // ASIT Initialization Function - Algorithm Keys
1377 //
1378 //   Name:      PAF_ASIT_initPhaseAlgKey
1379 //   Purpose:   Audio Stream Input Task Function for initialization of data values
1380 //              from parameters for Algorithm Keys.
1381 //   From:      audioStream1Task or equivalent
1382 //   Uses:      See code.
1383 //   States:    x
1384 //   Return:    0.
1385 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1386 //              * State information as per parent.
1387 //
1388 // .............................................................................
1389 Int
1390 PAF_ASIT_initPhaseAlgKey(
1391     const PAF_ASIT_Params *pP, 
1392     const PAF_ASIT_Patchs *pQ, 
1393     PAF_ASIT_Config *pC
1396     PAF_AST_Config *pAstCfg;
1397     Int as;                    /* Audio Stream Number (1, 2, etc.) */
1399     
1400     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1401     as = pAstCfg->as;
1402     (void)as;  // clear compiler warning in case not used with tracing disabled
1404     TRACE_VERBOSE1("PAF_ASIT_initPhaseAlgKey: AS%d: initialization phase - Algorithm Keys", as);
1406 #if 0 // FL: slave    
1407     for (z=DECODE1; z < DECODEN; z++) 
1408     {
1409         for (s=0; s < pP->pDecAlgKey->length; s++) 
1410         {
1411             if ((pP->pDecAlgKey->code[s].full != 0) &&
1412                 (that = PAF_ASP_chainFind (&pC->xDec[z].decChainData, pP->pDecAlgKey->code[s]))) 
1413             {
1414                 pC->xDec[z].decAlg[s] = (ALG_Handle )that->alg;
1415                 /* Cast in interface, for now --Kurt */
1416             }
1417             else
1418             {
1419                 pC->xDec[z].decAlg[s] = NULL;
1420             }
1421         }
1422     }
1423 #endif
1425     return 0;
1426 } //PAF_ASIT_initPhaseAlgKey
1428 // -----------------------------------------------------------------------------
1429 // ASIT Initialization Function - I/O Devices
1430 //
1431 //   Name:      PAF_ASIT_initPhaseDevice
1432 //   Purpose:   Audio Stream Input Task Function for initialization of I/O Devices.
1433 //   From:      audioStream1Task or equivalent
1434 //   Uses:      See code.
1435 //   States:    x
1436 //   Return:    0 on success.
1437 //              Source code line number on device allocation failure.
1438 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1439 //              * State information as per parent.
1440 //              * Memory allocation errors.
1441 //
1442 Int
1443 PAF_ASIT_initPhaseDevice(
1444     const PAF_ASIT_Params *pP, 
1445     const PAF_ASIT_Patchs *pQ, 
1446     PAF_ASIT_Config *pC
1449     PAF_AST_Config *pAstCfg;
1450     Int as;                             /* Audio Stream Number (1, 2, etc.) */
1451     Int z;                              /* input/output counter */
1452     PAF_SIO_IALG_Obj    *pObj;
1453     PAF_SIO_IALG_Config *pAlgConfig;
1454     PAF_IALG_Config pafAlgConfig;
1457     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1458     as = pAstCfg->as;
1459     (void)as; // clear compiler warning in case not used with tracing disabled
1461     TRACE_TERSE1("PAF_ASIT_initPhaseDevice: AS%d: initialization phase - I/O Devices", as);
1463     if (pP->fxns->bufMemPrint)
1464     {
1465         PAF_ALG_setup (&pafAlgConfig, 
1466             HEAP_ID_INTERNAL,               HEAP_INTERNAL, 
1467             HEAP_ID_INTERNAL1,              HEAP_INTERNAL1,
1468             HEAP_ID_EXTERNAL,               HEAP_EXTERNAL,
1469             HEAP_ID_INTERNAL1_SHM,          HEAP_INTERNAL1_SHM,
1470             HEAP_ID_EXTERNAL_SHM,           HEAP_EXTERNAL_SHM,
1471             HEAP_ID_EXTERNAL_NONCACHED_SHM, HEAP_EXTERNAL_NONCACHED_SHM,
1472             HEAP_CLEAR);
1473         TRACE_TERSE2("PAF_ASIT_initPhaseDevice: AS%d: calling PAF_ALG_setup with clear at %d.", as, HEAP_CLEAR);
1474     }
1476     for (z=INPUT1; z < INPUTN; z++) 
1477     {
1478         PAF_InpBufConfig *pConfig = &pAstCfg->xInp[z].inpBufConfig;
1480         pObj = (PAF_SIO_IALG_Obj *)pAstCfg->xInp[z].inpChainData.head->alg;
1481         pAlgConfig = &pObj->config;
1483         pAstCfg->xInp[z].hRxSio = NULL;
1485         pConfig->base.pVoid       = pAlgConfig->pMemRec[0].base;
1486         pConfig->pntr.pVoid       = pAlgConfig->pMemRec[0].base;
1487         pConfig->head.pVoid       = pAlgConfig->pMemRec[0].base;
1488         pConfig->futureHead.pVoid = pAlgConfig->pMemRec[0].base;
1489         pConfig->allocation       = pAlgConfig->pMemRec[0].size;
1490         pConfig->sizeofElement    = 2;
1491         pConfig->precision        = 16;
1493         if (pP->fxns->bufMemPrint)
1494         {
1495             pP->fxns->bufMemPrint(z, pAlgConfig->pMemRec[0].size, PAF_ALG_memSpaceToHeapId(&pafAlgConfig,pAlgConfig->pMemRec[0].space), 0);
1496         }
1497     }
1499     TRACE_TERSE1("PAF_ASIT_initPhaseDevice: AS%d: initialization phase - I/O Devices complete.", as);
1501     return 0;
1502 } //PAF_ASIT_initPhaseDevice
1504 // -----------------------------------------------------------------------------
1505 // ASIT Initialization Function - Decoder Output Circular Buffer
1506 //
1507 //   Name:      PAF_ASIT_initPhaseDecOpCircBuf
1508 //   Purpose:   Audio Stream Input Task Function for initialization of Decoder Output Circular Buffer.
1509 //   From:      audioStream1Task or equivalent
1510 //   Uses:      See code.
1511 //   States:    x
1512 //   Return:    0 on success.
1513 //              Source code line number on device allocation failure.
1514 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1515 //              * State information as per parent.
1516 //              * Memory allocation errors.
1517 //
1518 Int
1519 PAF_ASIT_initPhaseDecOpCircBuf(
1520     const PAF_ASIT_Params *pP, 
1521     const PAF_ASIT_Patchs *pQ, 
1522     PAF_ASIT_Config *pC
1525     PAF_AST_Config *pAstCfg;
1526     PAF_AST_DecOpCircBuf *pCb;          /* Decoder output circular buffer */
1527     Int as;                             /* Audio Stream Number (1, 2, etc.) */
1528     Int zMS;
1529     Int z;                              /* decode counter */
1530     Int errno;                          /* error number */
1531     Error_Block    eb;
1532     Int i;
1534     // FL: (***)revisit
1535     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1536     as = pAstCfg->as;
1537     zMS = pAstCfg->masterStr;
1539     /* Decode output circular buffer memory */
1540     if (!(pAstCfg->xDecOpCb = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, 
1541         DECODEN * sizeof (*pAstCfg->xDecOpCb), 4, &eb)))
1542     {
1543         TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1544         SW_BREAKPOINT;
1545         return __LINE__;
1546     }
1548     TRACE_TERSE3("PAF_ASIT_initPhaseDecOpCircBuf. (pC->xDecOpCb) %d bytes from space %d at 0x%x.",
1549         DECODEN * sizeof (*pAstCfg->xDecOpCb),
1550         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xDecOpCb);
1551         
1552     for (z=DECODE1; z < DECODEN; z++)
1553     {
1554         pCb = &pAstCfg->xDecOpCb[z];
1555         
1556         // allocate audio frame circular buffer
1557         if (!(pCb->afCb = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, ASP_DECOP_CB_MAX_NUM_AF * sizeof(PAF_AudioFrame), 4, &eb)))
1558         {
1559             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1560             SW_BREAKPOINT;
1561         }
1562         // allocate audio frame PCM sample pointer array
1563         for (i = 0; i<ASP_DECOP_CB_MAX_NUM_AF; i++)
1564         {
1565             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)))
1566             {
1567                 TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1568                 SW_BREAKPOINT;
1569             }
1570             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)))
1571             {
1572                 TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1573                 SW_BREAKPOINT;
1574             }                
1575         }
1576         // allocate PCM sample buffer
1577         if (!(pCb->pcmBuf = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_SHM, ASP_DECOP_CB_PCM_BUF_SZ * sizeof(PAF_AudioData), 4, &eb)))
1578         {
1579             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1580             SW_BREAKPOINT;
1581         }
1582         pCb->pcmBufEnd = pCb->pcmBuf + ASP_DECOP_CB_PCM_BUF_SZ;
1583         // allocate Metadata buffers //QIN
1584         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)))
1585         {
1586             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1587             SW_BREAKPOINT;
1588         }
1589         pCb->metaBufEnd = pCb->metaBuf + (ASP_DECOP_CB_MAX_NUM_AF * PAF_MAX_PRIVATE_MD_SZ * PAF_MAX_NUM_PRIVATE_MD);
1590         // (***) FL: revisit, here PCM is hard-coded for 256 sample dec op frame length        
1591         // Initialize decoder output circular buffer for PCM
1592         errno = cbInit(pCb);
1593         if (errno)
1594         {
1595             SW_BREAKPOINT; // FL: debug
1596             return errno;
1597         }
1598     }
1600     return 0;
1601 } //PAF_ASIT_initPhaseDecOpCircBuf
1604 #if 0
1605 // -----------------------------------------------------------------------------
1606 // AST Processing Function - Pass-Through Processing
1607 //
1608 //   Name:      PAF_AST_passProcessing
1609 //   Purpose:   Audio Stream Task Function for processing audio data as a
1610 //              pass-through from the input driver to the output driver
1611 //              for development and testing.
1612 //   From:      audioStream1Task or equivalent
1613 //   Uses:      See code.
1614 //   States:    x
1615 //   Return:    Error number in standard form (0 on success).
1616 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1617 //              * State information on initialization.
1618 //              * State information on processing.
1619 //
1621 #pragma CODE_SECTION(PAF_AST_passProcessing,".text:_PAF_AST_passProcessing")
1622 /* Pass Processing is often omitted from builds to save memory, */
1623 /* and CODE_SECTION/clink constructs facilitate this omission.  */
1625 Int
1626 PAF_AST_passProcessing(const PAF_AST_Params *pP, const PAF_AST_Patchs *pQ, PAF_AST_Config *pC, Int hack)
1628     Int z;                              /* input/output counter */
1629     Int errno = 0;                      /* error number */
1630     Int getVal;
1631     Int rxNumChan, txNumChan;
1632     Int first;
1633     Int zMD = pC->masterDec;
1634     Int zMI = pP->zone.master;
1637 #ifndef __TI_EABI__
1638     asm (" .clink"); /* See comment above regarding CODE_SECTION/clink. */
1639 #endif    
1641     TRACE_VERBOSE0("PAF_AST_passProcessing: initializing");
1643     //
1644     // Determine that receive/transmit channels are compatible
1645     //
1647     // Can handle handle only master input
1648     for (z=INPUT1; z < INPUTN; z++) {
1649         if (z != zMI && pC->xInp[z].hRxSio)
1650             return (ASPERR_PASS + 0x01);
1651     }
1653     /* Number of receive/transmit channels */
1655     if (! pC->xInp[zMI].hRxSio)
1656         return (ASPERR_PASS + 0x11);
1657     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &rxNumChan))
1658         return (ASPERR_PASS + 0x12);
1659     if (rxNumChan > NUM_TX_CHAN(zMI))
1660         return (ASPERR_PASS + 0x13);
1662     for (z=OUTPUT1; z < OUTPUTN; z++) {
1663         if (! pC->xOut[zMI].hTxSio)
1664             return (ASPERR_PASS + 0x10*(z+2) + 0x01);
1665         if (SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &txNumChan))
1666             return (ASPERR_PASS + 0x10*(z+2) + 0x02);
1667         if (txNumChan > NUM_TX_CHAN(zMI))
1668             return (ASPERR_PASS + 0x10*(z+2) + 0x03);
1669     }
1671     //
1672     // Set up receive/transmit
1673     //
1675     SIO_idle (pC->xInp[zMI].hRxSio);
1676     for (z=OUTPUT1; z < OUTPUTN; z++) {
1677         if(SIO_idle (pC->xOut[z].hTxSio))
1678             return ASPERR_IDLE;
1679     }
1681     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_SET_SOURCESELECT, PAF_SOURCE_PCM))
1682         return (ASPERR_PASS + 0x14);
1684     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, FRAMELENGTH))
1685         return (ASPERR_PASS + 0x15);
1687     for (z=OUTPUT1; z < OUTPUTN; z++)
1688         pC->xOut[z].outBufConfig.lengthofFrame = FRAMELENGTH;
1690     if (SIO_issue (pC->xInp[zMI].hRxSio, &pC->xInp[zMI].inpBufConfig, sizeof (pC->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_SYNC))
1691         return ASPERR_PASS + 0x16;
1693     if (SIO_reclaim (pC->xInp[zMI].hRxSio, (Ptr)&pC->xInp[zMI].pInpBuf, NULL) != sizeof (PAF_InpBufConfig))
1694         return ASPERR_PASS + 0x17;
1696     //
1697     // Receive and transmit the data in single-frame buffers
1698     //
1700     first = 1;
1701     while (pC->xDec[zMD].decodeStatus.sourceSelect == PAF_SOURCE_PASS) {
1702         PAF_OutBufConfig *pOutBuf;
1703         PAF_InpBufConfig *pInpBuf;
1705         if (first) {
1706             first = 0;
1708             TRACE_VERBOSE0("PAF_AST_passProcessing: starting output");
1710             for (z=OUTPUT1; z < OUTPUTN; z++) {
1711                 getVal = SIO_issue (pC->xOut[z].hTxSio, &pC->xOut[z].outBufConfig, sizeof(pC->xOut[z].outBufConfig), 0);
1712                 if (getVal > 0) {
1713                     errno = ASPERR_ISSUE;
1714                     break;
1715                 }
1716                 else if (getVal < 0) {
1717                     errno = -getVal;
1718                     break;
1719                 }
1721                 if (getVal = SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_UNMUTE, 0))
1722                     return (getVal & 0xff) | ASPERR_MUTE;
1723             }
1724             if (errno)
1725                 break;
1727         }
1729         getVal = SIO_issue (pC->xInp[zMI].hRxSio, &pC->xInp[zMI].inpBufConfig, sizeof (pC->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME);
1730         if (getVal > 0) {
1731             errno = ASPERR_ISSUE;
1732             break;
1733         }
1735         TRACE_VERBOSE1("PAF_AST_passProcessing: awaiting frame -- input size %d", rxNumChan * FRAMELENGTH);
1737         getVal = SIO_reclaim (pC->xInp[zMI].hRxSio, (Ptr) &pInpBuf, NULL);
1738         if (getVal < 0) {
1739             errno = -getVal;
1740             break;
1741         }
1743         for (z=OUTPUT1; z < OUTPUTN; z++) {
1744             getVal = SIO_reclaim (pC->xOut[z].hTxSio, (Ptr) &pOutBuf, NULL);
1745             if (getVal < 0) {
1746                 errno = -getVal;
1747                 break;
1748             }
1749         }
1750         if( errno )
1751             break;
1753         TRACE_VERBOSE0("PAF_AST_passProcessing: copying frame");
1755         if (errno = pP->fxns->passProcessingCopy (pP, pQ, pC))
1756             break;
1758         for (z=OUTPUT1; z < OUTPUTN; z++) {
1759             getVal = SIO_issue (pC->xOut[z].hTxSio, &pC->xOut[z].outBufConfig, sizeof(pC->xOut[z].outBufConfig), 0);
1760             if (getVal > 0) {
1761                 errno = ASPERR_ISSUE;
1762                 break;
1763             }
1764             else if (getVal < 0) {
1765                 errno = -getVal;
1766                 break;
1767             }
1768         }
1769         if( errno )
1770             break;
1771     }
1773     //
1774     // Close down receive/transmit
1775     //
1777     TRACE_TERSE0("PAF_AST_passProcessing: finalizing"));
1779     for (z=OUTPUT1; z < OUTPUTN; z++) {
1780         if (getVal = SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_MUTE, 0)) {
1781             if (! errno)
1782                 errno = (getVal & 0xff) | ASPERR_MUTE;
1783             /* convert to sensical errno */
1784         }
1785     }
1787     SIO_idle (pC->xInp[zMI].hRxSio);
1788     for (z=OUTPUT1; z < OUTPUTN; z++)
1789         SIO_idle (pC->xOut[z].hTxSio);
1791     return errno;
1793 } //PAF_AST_passProcessing
1794 #endif // #if 0
1796 #if 0
1797 // -----------------------------------------------------------------------------
1798 // AST Processing Function Helper - Pass-Through Processing Patch Point
1799 //
1800 //   Name:      PAF_AST_passProcessingCopy
1801 //   Purpose:   Pass-Through Processing Function for copying audio data
1802 //              from the input buffer to the output buffer.
1803 //   From:      AST Parameter Function -> passProcessing
1804 //   Uses:      See code.
1805 //   States:    x
1806 //   Return:    Error number in standard form (0 on success).
1807 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1808 //              x
1809 //
1811 #pragma CODE_SECTION(PAF_AST_passProcessingCopy,".text:_PAF_AST_passProcessingCopy")
1812 /* Pass Processing is often omitted from builds to save memory, */
1813 /* and CODE_SECTION/clink constructs facilitate this omission.  */
1815 Int
1816 PAF_AST_passProcessingCopy (const PAF_AST_Params *pP, const PAF_AST_Patchs *pQ, PAF_AST_Config *pC)
1818     Int z;                              /* output counter */
1819     Int errno;                          /* error number */
1820     Int i;
1821     Int rxNumChan, txNumChan;
1822     Int zMI = pP->zone.master;
1825     asm (" .clink"); /* See comment above regarding CODE_SECTION/clink. */
1827     // Copy data from input channels to output channels one of two ways:
1829     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &rxNumChan))
1830         return (ASPERR_PASS + 0x12);
1832     for (z=OUTPUT1; z < OUTPUTN; z++) {
1833         if (SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &txNumChan))
1834             return (ASPERR_PASS + 0x22);
1836         if( txNumChan <= rxNumChan ) {
1838             // Copy one to one, ignoring later rx channels as needed.
1840             for( i=0; i < txNumChan; i++ ) {
1841                 errno = pP->fxns->copy( i, &pC->xInp[zMI].inpBufConfig, i, &pC->xOut[z].outBufConfig );
1842                 if( errno )
1843                     return errno;
1844             }
1845         }
1846         else {
1848             // Copy one to many, repeating earlier rx channels as needed.
1850             Int from, to;
1852             from = 0;
1853             to   = 0;
1854             while( to < txNumChan ) {
1855                 errno = pP->fxns->copy( from, &pC->xInp[zMI].inpBufConfig, to, &pC->xOut[z].outBufConfig );
1856                 if( errno )
1857                     return errno;
1859                 from++;
1860                 to++;
1861                 if( from == rxNumChan )
1862                     from = 0;
1863             }
1864         }
1865     }
1867     return 0;
1868 } //PAF_AST_passProcessingCopy
1869 #endif // #if 0
1871 // -----------------------------------------------------------------------------
1872 // ASIT Processing Function - Auto Processing
1873 //
1874 //   Name:      PAF_ASIT_autoProcessing
1875 //   Purpose:   Audio Stream Input Task Function for processing audio data to
1876 //              determine the input type without output.
1877 //   From:      audioStream1Task or equivalent
1878 //   Uses:      See code.
1879 //   States:    x
1880 //   Return:    Error number in standard or SIO form (0 on success).
1881 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1882 //              * State information on initialization.
1883 //
1885 #define DECSIOMAP(X)                                                \
1886     pP->pDecSioMap->map[(X) >= pP->pDecSioMap->length ? 0 : (X)]
1888 Int
1889 PAF_ASIT_autoProcessing(
1890     const PAF_ASIT_Params *pP, 
1891     const PAF_ASIT_Patchs *pQ, 
1892     PAF_ASIT_Config *pC, 
1893     Int inputTypeSelect, 
1894     ALG_Handle pcmAlgMaster
1897     PAF_AST_Config *pAstCfg;
1898     Int as;                 /* Audio Stream Number (1, 2, etc.) */
1899     Int errno = 0;          /* error number */
1900     Int nbytes;
1901     Int frameLength;
1902     Int zMD;
1903     Int zMI;
1904     Int zMS;
1905     
1906     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1907     as = pAstCfg->as;
1908     zMD = pAstCfg->masterDec;
1909     zMS = pAstCfg->masterStr;    
1910     zMI = pP->zone.master;    
1911     
1912     TRACE_VERBOSE1("PAF_ASIT_autoProcessing: AS%d: PAF_AST_autoProcessing", as+zMS);
1914     if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio,
1915                          PAF_SIO_CONTROL_SET_SOURCESELECT,
1916                          DECSIOMAP(pAstCfg->xDec[zMD].decodeStatus.sourceSelect)))
1917     {
1918         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: AS%d: source select returns 0x%x", as+zMS, errno);
1919         return errno;
1920     }
1921     //frameLength = pP->fxns->computeFrameLength (pcmAlgMaster, FRAMELENGTH,
1922     //                                            pC->xDec[zMD].decodeStatus.bufferRatio);
1923     frameLength = FRAMELENGTH; // FL: fix PCM frameLength for alpha release.
1925     if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio,
1926                          PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, frameLength))
1927     {
1928         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: SET_PCMFRAMELENGTH returns 0x%x, returning ASPERR_AUTO_LENGTH, 0x%x",
1929             errno, ASPERR_AUTO_LENGTH);
1930         return ASPERR_AUTO_LENGTH;
1931     }
1933     if (errno = SIO_issue(pAstCfg->xInp[zMI].hRxSio,
1934                           &pAstCfg->xInp[zMI].inpBufConfig, sizeof(pAstCfg->xInp[zMI].inpBufConfig),
1935                           PAF_SIO_REQUEST_SYNC))
1936     {
1937         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: REQUEST_SYNC returns 0x%x, returning ASPERR_ISSUE, 0x%x",
1938             errno, ASPERR_ISSUE);
1939         return ASPERR_ISSUE;
1940     }
1942     TRACE_VERBOSE1("PAF_ASIT_autoProcessing: AS%d: awaiting sync", as+zMS);
1944     // all of the sync scan work is done in this call. If the error returned
1945     // is DIBERR_SYNC then that just means we didn't find a sync, not a real I/O
1946     // error so we mask it off.
1947     nbytes = SIO_reclaim(pAstCfg->xInp[zMI].hRxSio, (Ptr)&pAstCfg->xInp[zMI].pInpBuf, NULL);
1948     if (nbytes == -DIBERR_SYNC)
1949     {
1950 #if 1 // (***) FL: shows timing of autosync restart
1951         // (***) debug // B5
1952         {
1953             static Uint8 toggleState = 0;
1954             if (toggleState == 0)
1955                 GPIOSetOutput(GPIO_PORT_0, GPIO_PIN_99);
1956             else
1957                 GPIOClearOutput(GPIO_PORT_0, GPIO_PIN_99);
1958             toggleState = ~(toggleState);
1959         }
1960 #endif                
1961         TRACE_TERSE2("PAF_ASIT_autoProcessing: AS%d: SIO_reclaim returned 0x%x, ignoring", as+zMS, nbytes);
1962         return nbytes;
1963     }
1964     if (nbytes != sizeof(PAF_InpBufConfig))
1965     {
1966         TRACE_TERSE3("PAF_ASIT_autoProcessing. SIO_reclaim returned %d, not %d, returning ASPERR_RECLAIM (0x%x)",
1967             nbytes, sizeof(PAF_InpBufConfig), ASPERR_RECLAIM);
1968         return ASPERR_RECLAIM;
1969     }
1970     if (errno)
1971     {
1972         TRACE_TERSE2("PAF_ASIT_autoProcessing: AS%d: returning errno 0x%x", as+zMS, errno);
1973     }
1974     return errno;
1975 } //PAF_ASIT_autoProcessing
1977 UInt32 gProbe1Err=0;
1978 UInt32 gProbe2Err=0;
1979 UInt32 gMajorAuMissed=0;
1981 // -----------------------------------------------------------------------------
1982 // ASIT Processing Function - Decode Processing
1983 //
1984 //   Name:      PAF_ASIT_decodeProcessing
1985 //   Purpose:   Audio Stream Input Task Function for processing audio data.
1986 //   From:      audioStream1Task or equivalent
1987 //   Uses:      See code.
1988 //   States:    x
1989 //   Return:    Error number in standard form (0 on success).
1990 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1991 //              * State information on initialization (via children).
1992 //              * State information on processing (via children).
1993 //              * Decode warnings.
1994 //
1995 // When "writeDECModeContinuous" is used for zMI input/decode:
1996 // PAF_AST_decodeProcessing() loop may be (is designed to be) exited:
1997 // (a) if "writeDECCommandRestart" is used
1998 //    (or "writeDECCommandAbort", but this performs no cleanup whatsoever, and so its use is discouraged)
1999 // (b) if "writeDECSourceSelectNone" is used
2000 // [ the latter events lead to QUIT state, simply for exiting (errme = errno = ASPERR_QUIT)
2001 // (c) if an error occurs in
2002 //     INIT
2003 //     CONT ("subsequent block state", which "Establish[es] secondary timing")
2004 //         -> PAF_AST_decodeCont(): "Await slave inputs"
2005 //     STREAM (errno |= PAF_COMPONENT_ASP)
2006 //     ENCODE (errno |= PAF_COMPONENT_ENCODE)
2007 // [ the latter errors lead to "switch_break:"
2008 //         -> PAF_AST_decodeComplete(), which always returns 0 (no error) ]
2009 //
2010 // [ Notably, in FINAL ("frame-finalization state")
2011 //         -> PAF_AST_decodeFinalTest() is *not* called,
2012 //   and so any other (asynchronous) changes in pC->xDec[zMD].decodeStatus.sourceSelect are ignored. ]
2013 // [ For completeness, note also: "default" state, internal check (errme = errno = ASPERR_UNKNOWNSTATE) ]
2014 //
2015 // States in which error can't occur:
2016 //     AGAIN ("subsequent initial state")
2017 //
2018 // States in which (some) errors must be handled:
2019 //     INFO1 ("first frame state")
2020 //         -> PAF_AST_decodeInfo(): pass on ASPERR_INFO_RATECHANGE, ASPERR_INFO_PROGRAM ("bad" internal error)
2021 //            -> *DONE* must "catch" ASPERR_RECLAIM from SIO_reclaim (pC->xInp[zMI].hRxSio) -- note zMI only **
2022 //               ?*? but what about ASPERR_RESYNC from same call ?*?
2023 //            -> *for now, at least, pass on error from pP->fxns->updateInputStatus ()*
2024 //            -> *DONE* must "catch" error from (zMI) dec->fxns->info() **
2025 //         -> PAF_AST_decodeInfo1(): pass on any errors which occur here:
2026 //            - pP->fxns->streamChainFunction (... PAF_ASP_CHAINFRAMEFXNS_RESET)
2027 //            - enc->fxns->info()
2028 //            - pP->fxns->setCheckRateX()
2029 //            - pP->fxns->startOutput()
2030 //            - "Start slave inputs if necessary"
2031 //     INFO2 ("subsequent frame state")
2032 //         -> PAF_AST_decodeInfo(): (see above)
2033 //         -> PAF_AST_decodeInfo2(): pass on any errors which occur here:
2034 //            - pP->fxns->setCheckRateX()
2035 //     TIME ("timing state")
2036 //         -> PAF_AST_decodeTime(): "Special timing consideations for AC-3"
2037 //         -> performs SIO_issue (... PAF_SIO_REQUEST_FULLFRAME) & SIO_reclaim() *for zMI only*
2038 //         -> now, DIB_issue [PAF_SIO_REQUEST_FULLFRAME] would only return SYS_EINVAL for "bad" internal error
2039 //            (*OK* don't try to recover from this*)
2040 //         -> much more likely would be SIO_reclaim() error (ASPERR_RECLAIM)
2041 //         -> *DONE* must "catch" (just) ASPERR_RECLAIM error -- note zMI only,
2042 //            possibly in PAF_AST_decodeProcessing() itself **
2043 //     DECODE ("decode state")
2044 //         -> PAF_AST_decodeDecode(): pass on error from
2045 //            - PAF_SIO_CONTROL_GET_NUM_REMAINING ("bad" internal error)
2046 //            - dec->fxns->reset()
2047 //            - PAF_SIO_CONTROL_SET_PCMFRAMELENGTH
2048 //         -> *DONE* must catch error from (zMI) dec->fxns->decode()
2049 //         -> *?* must catch ASPERR_ISSUE from (zMI) SIO_issue()
2050 Int
2051 PAF_ASIT_decodeProcessing(
2052     const PAF_ASIT_Params *pP, 
2053     const PAF_ASIT_Patchs *pQ, 
2054     PAF_ASIT_Config *pC, 
2055     Int sourceSelect
2058     PAF_AST_Config *pAstCfg;
2059     //Int as = pC->as;                    /* Audio Stream Number (1, 2, etc.) */
2060     Int z;                              /* decode counter */
2061     Int errno;                          /* error number */
2062     Int getVal;
2063     enum { INIT, INFO1, INFO2, DECODE, FINAL, QUIT } state;
2064     ALG_Handle alg[DECODEN_MAX];
2065     Int zMD;
2066     Int zMS;
2067     Int size;
2068     //PAF_InpBufConfig *pIpBufConfig;
2069     Int frame; // decoder input frame count
2070     Int block; // (***) FL: formerly  -- decoder output block count / input frame
2071 #ifdef NON_CACHE_STATUS
2072     Int8 tempVar8, temp2Var8;
2073 #endif
2074     
2075     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
2076     zMD = pAstCfg->masterDec;
2077     zMS = pAstCfg->masterStr;
2078         
2079     for (z=DECODE1; z < DECODEN; z++)
2080     {
2081         alg[z] = pAstCfg->xDec[z].decAlg[PAF_SOURCE_PCM];        
2082     }
2083     alg[zMD] = NULL; // decAlgMaster; // FL: alg[] init is on slave
2085     //
2086     // Receive and process the data in single-frame buffers
2087     //
2089     state = INIT;
2090     errno = 0; /* error number */
2092 #ifdef NON_CACHE_STATUS
2093     statusOp_read(&tempVar8,
2094                   &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
2095                   sizeof(tempVar8),
2096                   GATEMP_INDEX_DEC);
2097     TRACE_TERSE1("PAF_ASIT_decodeProcessing: sourceSelect is %d", tempVar8);
2099     for (;;) 
2100     {
2101         statusOp_read(&tempVar8,
2102                       &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
2103                     sizeof(tempVar8),
2104                     GATEMP_INDEX_DEC);
2105         if (tempVar8 == PAF_SOURCE_NONE)
2106         {
2107 #else
2108     TRACE_TERSE1("PAF_ASIT_decodeProcessing: sourceSelect is %d", pAstCfg->xDec[zMD].decodeStatus.sourceSelect);
2110     for (;;)
2111     {
2112         if (pAstCfg->xDec[zMD].decodeStatus.sourceSelect == PAF_SOURCE_NONE)
2113         {
2114 #endif
2115             TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: sourceSelect == PAF_SOURCE_NONE");
2116             state = QUIT;
2117         }
2119         // Process commands (decode)
2120         if (getVal = pP->fxns->decodeCommand(pP, pQ, pC)) 
2121         {
2122             if (state != INIT)   // no need to restart/abort if not yet started
2123             {
2124                 if (getVal == ASPERR_QUIT)
2125                 {
2126                     state = QUIT;
2127                     TRACE_VERBOSE0("PAF_ASIT_decodeProcessing. %d: state = QUIT");
2128                 }
2129                 else if (getVal == ASPERR_ABORT)
2130                 {
2131                     TRACE_VERBOSE0("PAF_ASIT_decodeProcessing. %d: return getVal");
2132                     return getVal;
2133                 }
2134                 else
2135                 {
2136                     /* ignore */;
2137                 }
2138             }
2139             TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state == INIT");
2140         }
2142         TRACE_TIME((&TIME_MOD,         "... + %d = %d ->", dtime(), TSK_time()));
2143         TRACE_TIME((&TIME_MOD,         "                 state = %s", stateName[state]));
2145         // Process state (decode)
2146         switch (state) 
2147         {
2148             case INIT: // initial state
2149                 gAsipInitCnt++;
2150                 Log_info0("TaskAsip: state=INIT");               
2152                 if (errno = pP->fxns->decodeInit(pP, pQ, pC, sourceSelect))
2153                 {
2154                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INIT, errno 0x%x.  break after decodeInit", errno);
2155                     break;
2156                 }
2157                                
2158                 frame = 0;
2159                 block = 0;
2161                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INIT->INFO1");
2162                 state = INFO1;
2163                 continue;
2165             case INFO1: // first frame state
2166                 gAsipInfo1Cnt++;
2167                 Log_info0("TaskAsip: state=INFO1");
2168                 
2169                 // Establish primary timing
2170                 if (errno = pP->fxns->decodeInfo(pP, pQ, pC, frame, block))
2171                 {
2172                     gAsipInfo1_PrimaryErrCnt++;
2173                     TRACE_TERSE1("INFO1: errno 0x%x after decodeInfo, primary timing", errno);
2174                     break;
2175                 }
2176                 
2177 #ifdef NON_CACHE_STATUS
2178                 statusOp_read(&tempVar8,
2179                               &(pAstCfg->xDec[zMD].decodeStatus.sourceDecode),
2180                               sizeof(tempVar8),
2181                               GATEMP_INDEX_DEC);
2182                 statusOp_read(&temp2Var8,
2183                               &(pAstCfg->xDec[zMD].decodeStatus.sampleRate),
2184                               sizeof(tempVar8),
2185                               GATEMP_INDEX_DEC);
2186                 // Don't start decode until major access unit is found.
2187                 if (((tempVar8 == PAF_SOURCE_THD)    ||
2188                      (tempVar8 == PAF_SOURCE_DXP)    ||
2189                      (tempVar8 == PAF_SOURCE_DTSHD)) &&
2190                      (temp2Var8 == PAF_SAMPLERATE_UNKNOWN)) 
2191 #else
2192                 // Don't start decode until major access unit is found.
2193                 if (((pAstCfg->xDec[zMD].decodeStatus.sourceDecode == PAF_SOURCE_THD)    ||
2194                      (pAstCfg->xDec[zMD].decodeStatus.sourceDecode == PAF_SOURCE_DXP)    ||
2195                      (pAstCfg->xDec[zMD].decodeStatus.sourceDecode == PAF_SOURCE_DTSHD)) &&
2196                      (pAstCfg->xDec[zMD].decodeStatus.sampleRate == PAF_SAMPLERATE_UNKNOWN))
2197 #endif
2198                 {
2199                     Int z;
2200                     for (z=DECODE1; z < DECODEN; z++) 
2201                     {
2202                         Int zI = pP->inputsFromDecodes[z];
2203 #ifdef NON_CACHE_STATUS
2204                         statusOp_read(&tempVar8,
2205                                       &(pAstCfg->xDec[z].decodeStatus.mode),
2206                                       sizeof(tempVar8),
2207                                       GATEMP_INDEX_DEC);
2208                         if (pAstCfg->xInp[zI].hRxSio && tempVar8)
2209                         {
2210 #else
2211                         if (pAstCfg->xInp[zI].hRxSio && pAstCfg->xDec[z].decodeStatus.mode)
2212                         {
2213 #endif
2214                             TRACE_VERBOSE0("TaskAsip: PAF_ASIT_decodeProcessing: INFO1, SIO_issue");
2215                             if (SIO_issue(pAstCfg->xInp[zI].hRxSio, &pAstCfg->xInp[zI].inpBufConfig,
2216                                 sizeof(pAstCfg->xInp[zI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME))
2217                             {
2218                                 gProbe2Err++;
2219                                 TRACE_TERSE0("PAF_ASIT_decodeProcessing. %d: INFO1, return (ASPERR_ISSUE)");
2220                                 return (ASPERR_ISSUE);
2221                             }
2222                         }
2223                     }
2224                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1: frame %d, not major access unit", frame);
2225                     gMajorAuMissed++; // debug
2226                     frame++;
2227                     state = INFO1;
2228                     continue;
2229                 }
2230                 TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1: frame %d, major access unit found", frame);
2232                 // Establish secondary timing
2233                 if (errno = pP->fxns->decodeInfo1(pP, pQ, pC, frame, block))
2234                 {
2235                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1, errno 0x%x.  break after decodeInfo1", errno);
2236                     gAsipInfo1_ErrCnt++;
2237                     break;
2238                 }
2240                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INFO1->DECODE");
2241                 state = DECODE;
2242                 continue;
2244             case INFO2: // subsequent frame state
2245                 gAsipInfo2Cnt++;
2246                 Log_info0("TaskAsip: state=INFO2");
2248                 // Establish primary timing
2249                 if (errno = pP->fxns->decodeInfo(pP, pQ, pC, frame, block))
2250                 {
2251                     TRACE_TERSE1("PAF_ASIT_decodeProcessing: INFO2 break on decodeInfo. errno 0x%x", errno);
2252                     gAsipInfo2_PrimaryErrCnt++;
2253                     break;
2254                 }
2255                                 
2256                 // Measure cycles in decode processing loop.
2257                 // Only measures cycles spent in loop.
2258                 pfpEnd(PFP_ID_ASIT_1, PFP_FINISH_MEAS);     // PFP end
2259                 pfpBegin(PFP_ID_ASIT_1, pC->taskHandle);    // PFP begin
2261                 if (errno = pP->fxns->decodeInfo2(pP, pQ, pC, frame, block))
2262                 {
2263                     TRACE_TERSE1("PAF_ASIT_decodeProcessing. %d: INFO2 break on decodeInfo2. errno 0x%x", errno);
2264                     gAsipInfo2_ErrCnt++;
2265                     break;
2266                 }
2267                
2268                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INFO2->DECODE");
2269                 state = DECODE;
2270                 continue;
2272             case DECODE: // decode state
2273                 gAsipDecodeCnt++;
2274                 Log_info0("TaskAsip: state=DECODE");
2276                 if (errno = pP->fxns->decodeDecode(pP, pQ, pC, sourceSelect, frame, block))
2277                 {
2278                         gAsipDecodeErrCnt++;
2279                         TRACE_TERSE1("PAF_ASIT_decodeProcessing: state: DECODE.  decodeDecode err 0x%04x", errno);
2280                     break;
2281                 }
2282                 
2283                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: DECODE->FINAL");
2284                 state = FINAL;
2285                 continue;
2287             case FINAL: // frame-finalization state
2288                 gAsipFinalCnt++;
2289                 Log_info0("TaskAsip: state=FINAL");
2291                 // Check for final frame, and if indicated:
2292                 // - Exit state machine to "complete" processing.
2293                 if (pP->fxns->decodeFinalTest(pP, pQ, pC, frame, block)) 
2294                 {
2295                     break;
2296                 }
2298                 frame++;
2299                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: FINAL->AGAIN");
2300                 state = INFO2;
2301                 continue;
2303             case QUIT: // exit state
2304                 gAsipQuitCnt++;
2305                 Log_info0("TaskAsip: state=QUIT");
2307                 // Quit:
2308                 // - Set error number registers.
2309                 // - Exit state machine to "decode complete" processing.
2310                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: QUIT");
2311                 errno = ASPERR_QUIT;
2312                 break;
2314             default: // unknown state
2316                 // Unknown:
2317                 // - Set error number registers.
2318                 // - Exit state machine to "decode complete" processing.
2320                 TRACE_TERSE1("PAF_ASIT_decodeProcessing: state: unknown, 0x%x", state);
2321                 errno = ASPERR_UNKNOWNSTATE;
2322                 break;
2324         }  // End of switch (state).
2326         pfpEnd(PFP_ID_ASIT_1, PFP_FINISH_MEAS); // PFP end -- outside of PFP for errors, EOS, or Input SIO change
2327         
2328         TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: Calling decode complete");
2329         if (pP->fxns->decodeComplete(pP, pQ, pC, alg, frame, block))
2330         {
2331             /* ignored? */;
2332         }
2333         
2334         TRACE_TIME((&TIME_MOD, "as1-f2: ... + %d = ?? (final? %d)", dtime(), state == FINAL));
2336         return errno;
2337     }  // End of for (;;) to Receive, process, and transmit the data.
2338 } //PAF_ASIT_decodeProcessing
2340 // -----------------------------------------------------------------------------
2341 // ASIT Decoding Function - Decode Command Processing
2342 //
2343 //   Name:      PAF_ASIT_decodeCommand
2344 //   Purpose:   Decoding Function for processing Decode Commands.
2345 //   From:      AST Parameter Function -> decodeProcessing
2346 //   Uses:      See code.
2347 //   States:    x
2348 //   Return:    Error number in standard form (0 on success).
2349 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2350 //              * Command execution.
2351 //
2353 Int
2354 PAF_ASIT_decodeCommand(
2355     const PAF_ASIT_Params *pP, 
2356     const PAF_ASIT_Patchs *pQ, 
2357     PAF_ASIT_Config *pC
2360     PAF_AST_Config *pAstCfg;
2361     Int as;                 /* Audio Stream Number (1, 2, etc.) */
2362     Int z;                  /* decode counter */
2363     Int zS;
2364 #ifdef NON_CACHE_STATUS
2365     Int8 tempVar8;
2366 #endif
2368     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
2369     as = pAstCfg->as;
2371     for (z=DECODE1; z < DECODEN; z++) 
2372     {
2373         zS = pP->streamsFromDecodes[z];
2374 #ifdef NON_CACHE_STATUS
2375         statusOp_read(&tempVar8,
2376                       &(pAstCfg->xDec[z].decodeStatus.command2),
2377                       sizeof(tempVar8),
2378                       GATEMP_INDEX_DEC);
2379         if (!(tempVar8 & 0x80))
2380         {
2381             switch (tempVar8)
2382             {
2383                 case 0: // command none - process
2384                     tempVar8 |= 0x80;
2385                     statusOp_write(&(pAstCfg->xDec[z].decodeStatus.command2),
2386                                    &tempVar8,
2387                                    sizeof(tempVar8),
2388                                    GATEMP_INDEX_DEC);
2389                     break;
2390                 case 1: // command abort - leave now
2391                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command abort (0x%02x)", as+zS, 1);
2392                     tempVar8 |= 0x80;
2393                     statusOp_write(&(pAstCfg->xDec[z].decodeStatus.command2),
2394                                    &tempVar8,
2395                                    sizeof(tempVar8),
2396                                    GATEMP_INDEX_DEC);
2397                     return (ASPERR_ABORT);
2398                 case 2: // command restart - leave later
2399                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command quit (0x%02x)", as+zS, 2);
2400                     tempVar8 |= 0x80;
2401                     statusOp_write(&(pAstCfg->xDec[z].decodeStatus.command2),
2402                                    &tempVar8,
2403                                    sizeof(tempVar8),
2404                                    GATEMP_INDEX_DEC);
2405                     return (ASPERR_QUIT);
2406                 default: // command unknown - ignore
2407                     break;
2408             }
2409         }
2410 #else
2411         if (!(pAstCfg->xDec[z].decodeStatus.command2 & 0x80))
2412         {
2413             switch (pAstCfg->xDec[z].decodeStatus.command2)
2414             {
2415                 case 0: // command none - process
2416                     pAstCfg->xDec[z].decodeStatus.command2 |= 0x80;
2417                     break;
2418                 case 1: // command abort - leave now
2419                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command abort (0x%02x)", as+zS, 1);
2420                     pAstCfg->xDec[z].decodeStatus.command2 |= 0x80;
2421                     return (ASPERR_ABORT);
2422                 case 2: // command restart - leave later
2423                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command quit (0x%02x)", as+zS, 2);
2424                     pAstCfg->xDec[z].decodeStatus.command2 |= 0x80;
2425                     return (ASPERR_QUIT);
2426                 default: // command unknown - ignore
2427                     break;
2428             }
2429         }
2430 #endif
2431     }
2433     return 0;
2434 } //PAF_ASIT_decodeCommand
2436 // -----------------------------------------------------------------------------
2437 // ASIT Decoding Function - Reinitialization of Decode
2438 //
2439 //   Name:      PAF_ASIT_decodeInit
2440 //   Purpose:   Decoding Function for reinitializing the decoding process.
2441 //   From:      AST Parameter Function -> decodeProcessing
2442 //   Uses:      See code.
2443 //   States:    x
2444 //   Return:    Error number in standard or SIO form (0 on success).
2445 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2446 //              * State information as per parent.
2447 //
2448 Int
2449 PAF_ASIT_decodeInit(
2450     const PAF_ASIT_Params *pP, 
2451     const PAF_ASIT_Patchs *pQ, 
2452     PAF_ASIT_Config *pC, 
2453     Int sourceSelect
2456     PAF_AST_Config *pAstCfg;
2457     PAF_AST_DecOpCircBufCtl *pCbCtl;    /* Decoder output circular buffer control */
2458     Int as;                             /* Audio Stream Number (1, 2, etc.) */
2459     Int z;                              /* decode/encode counter */
2460     Int errno;                          /* error number */
2461     Int zI, zS;
2462     Int zMD;
2463     Int zMI;
2464     ASP_Msg* pAspMsg;                   /* Messaging */
2465     Int argIdx;
2466     Int status;
2467 #ifdef NON_CACHE_STATUS
2468     Int8 tempVar8;
2469 #endif
2470     
2471     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
2472     as = pAstCfg->as;
2473     zMD = pAstCfg->masterDec;
2474     zMI = pP->zone.master;
2475     (void)as;  // clear compiler warning in case not used with tracing disabled
2476     
2477     pCbCtl = &pC->pAspmCfg->decOpCircBufCtl; // get pointer to circular buffer control
2479 #ifdef NON_CACHE_STATUS
2480     // reset frameCount
2481     for (z=DECODE1; z < DECODEN; z++)
2482     {
2483         statusOp_read(&tempVar8,
2484                       &(pAstCfg->xDec[z].decodeStatus.mode),
2485                       sizeof(tempVar8),
2486                       GATEMP_INDEX_DEC);
2487         if (tempVar8)
2488         {
2489             tempVar8 = 0;
2490             statusOp_write(&(pAstCfg->xDec[z].decodeStatus.frameCount),
2491                           &tempVar8,
2492                           sizeof(tempVar8),
2493                           GATEMP_INDEX_DEC);
2494         }
2495     }
2497     for (z=DECODE1; z < DECODEN; z++) 
2498     {
2499         zI = pP->inputsFromDecodes[z];
2500         zS = pP->streamsFromDecodes[z];
2501         (void)zS; // clear compiler warning in case not used with tracing disabled
2502         statusOp_read(&tempVar8,
2503                       &(pAstCfg->xDec[z].decodeStatus.mode),
2504                       sizeof(tempVar8),
2505                       GATEMP_INDEX_DEC);
2506         if (pAstCfg->xInp[zI].hRxSio && tempVar8)
2507         {
2508 #else
2509     // reset frameCount
2510     for (z=DECODE1; z < DECODEN; z++)
2511     {
2512         if (pAstCfg->xDec[z].decodeStatus.mode)
2513         {
2514             pAstCfg->xDec[z].decodeStatus.frameCount = 0;
2515         }
2516     }
2518     for (z=DECODE1; z < DECODEN; z++)
2519     {
2520         zI = pP->inputsFromDecodes[z];
2521         zS = pP->streamsFromDecodes[z];
2522         (void)zS; // clear compiler warning in case not used with tracing disabled
2523         if (pAstCfg->xInp[zI].hRxSio && pAstCfg->xDec[z].decodeStatus.mode)
2524         {
2525 #endif
2526             Uns gear;
2527             Int frameLength;
2528             TRACE_VERBOSE1("AS%d: PAF_ASIT_decodeInit: initializing decode", as+zS);
2530             // write back Dec configuration
2531             Cache_wb(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2532             Cache_wait();
2534             // FL: send dec activate message to slave
2535             pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize);  /* allocate message */
2536             if (pAspMsg == NULL)
2537             {
2538                 TRACE_TERSE0("MessageQ_alloc() failure.");
2539                 SW_BREAKPOINT; // temporary
2540                 return -1; // temporary
2541             }
2542             MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
2543             pAspMsg->cmd = ASP_SLAVE_DEC_ACTIVATE;                                              /* fill in message payload */
2544             pAspMsg->procId = hAspMsgMaster->masterProcId;
2545             pAspMsg->expectResp = TRUE;
2546             pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
2547             argIdx = 0; // set decIdx (zone index)
2548             *(Int32 *)&pAspMsg->buf[argIdx] = z;
2549             TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2550             TRACE_MSG1("decIdx=%d", pAspMsg->buf[0]);
2551             status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);                       /* send message */
2552             if (status != MessageQ_S_SUCCESS)
2553             {
2554                 SW_BREAKPOINT;
2555             }
2556             // wait for dec activate complete message from slave
2557             status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
2558             if (status != MessageQ_S_SUCCESS)
2559             {
2560                 TRACE_TERSE0("MessageQ_get() failure.");
2561                 SW_BREAKPOINT; // temporary
2562                 return -1; // temporary
2563             }
2564             if ((pAspMsg->procId != hAspMsgMaster->slaveProcId) || 
2565                 (pAspMsg->cmd != ASP_MASTER_DEC_ACTIVATE_DONE) ||
2566                 (pAspMsg->messageId != (hAspMsgMaster->messageId | ((UInt32)1<<31))))
2567             {
2568                 TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2569                 SW_BREAKPOINT; // temporary
2570                 return -1; // temporary
2571             }      
2572             hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
2573             TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2574             // free the message
2575             status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
2576             if (status != MessageQ_S_SUCCESS)
2577             {
2578                 SW_BREAKPOINT;
2579             }
2580             
2581 #if 0 // FL: decoder activate call, slave
2582             if (decAlg[z]->fxns->algActivate)
2583                 decAlg[z]->fxns->algActivate (decAlg[z]);
2584 #endif
2586             // FL: send dec reset message to slave
2587             pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize);  /* allocate message */
2588             if (pAspMsg == NULL)
2589             {
2590                 TRACE_TERSE0("MessageQ_alloc() failure.");
2591                 SW_BREAKPOINT; // temporary
2592                 return -1; // temporary
2593             }
2594             MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
2595             pAspMsg->cmd = ASP_SLAVE_DEC_RESET;                                                 /* fill in message payload */
2596             pAspMsg->procId = hAspMsgMaster->masterProcId;
2597             pAspMsg->expectResp = TRUE;
2598             pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
2599             argIdx = 0; // set decIdx
2600             *(Int32 *)&pAspMsg->buf[argIdx] = z;
2601             TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2602             TRACE_MSG1("decIdx=%d", pAspMsg->buf[0]);
2603             // wait for dec reset complete message from slave
2604             status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message */
2605             if (status != MessageQ_S_SUCCESS)
2606             {
2607                 SW_BREAKPOINT;
2608             }
2609             status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
2610             if (status != MessageQ_S_SUCCESS)
2611             {
2612                 TRACE_TERSE0("MessageQ_get() failure.");
2613                 SW_BREAKPOINT; // temporary
2614                 return -1; // temporary
2615             }
2616             if ((pAspMsg->procId == hAspMsgMaster->slaveProcId) &&
2617                 (pAspMsg->cmd == ASP_MASTER_DEC_RESET_DONE) && 
2618                 (pAspMsg->messageId == (hAspMsgMaster->messageId | ((UInt32)1<<31))))
2619             {
2620                 hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
2621                 TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2622                 TRACE_MSG1("decErrno=%d", pAspMsg->buf[0]);
2624                 argIdx = 0; // get decErrno
2625                 errno = *(Int32 *)&pAspMsg->buf[argIdx];
2626             }
2627             else
2628             {
2629                 //
2630                 // Invalid message received
2631                 //
2632                 TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2633                 SW_BREAKPOINT; // temporary
2634                 return -1; // temporary
2635             }
2636             // free the message
2637             status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
2638             if (status != MessageQ_S_SUCCESS)
2639             {
2640                 SW_BREAKPOINT;
2641             }
2642             
2643             // (***) FL: revisit
2644             // invalidate Dec configuration
2645             Cache_inv(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2646             Cache_wait();
2647             
2648 #if 0 // FL: decoder reset call, slave
2649             if (dec->fxns->reset
2650                 && (errno = dec->fxns->reset (dec, NULL,
2651                                               &pC->xDec[z].decodeControl, &pC->xDec[z].decodeStatus)))
2652                 return errno;
2653 #endif
2654             if (errno != 0)
2655             {
2656                 return errno;
2657             }
2658             
2659 #ifdef NON_CACHE_STATUS
2660             gear = 0;  // due to size difference
2661             statusOp_read(&gear,
2662                           &(pAstCfg->xDec[z].decodeStatus.aspGearControl),
2663                           sizeof(Int8),
2664                           GATEMP_INDEX_DEC);
2665             tempVar8 = gear < GEARS ? gear : 0;
2666             statusOp_write(&(pAstCfg->xDec[z].decodeStatus.aspGearStatus),
2667                            &tempVar8,
2668                            sizeof(tempVar8),
2669                            GATEMP_INDEX_DEC);
2670 #else
2671             gear = pAstCfg->xDec[z].decodeStatus.aspGearControl;
2672             pAstCfg->xDec[z].decodeStatus.aspGearStatus = gear < GEARS ? gear : 0;
2673 #endif
2674             
2675 #if 0 // FL: change handle to decIdx (zone index)
2676             frameLength = pP->fxns->computeFrameLength(decAlg[z], 
2677                 FRAMELENGTH,
2678                 pC->xDec[z].decodeStatus.bufferRatio);
2679 #endif
2680 #if 0 // (***) FL: revisit. Bypass computeFrameLength().
2681             frameLength = pP->fxns->computeFrameLength(z, 
2682                 FRAMELENGTH, 
2683                 pC->xDec[z].decodeStatus.bufferRatio);
2684 #else
2685             if (sourceSelect == PAF_SOURCE_PCM)
2686             {
2687                 frameLength = PAF_SYS_FRAMELENGTH;
2688             }
2689             else if ((sourceSelect == PAF_SOURCE_DDP) || (sourceSelect == PAF_SOURCE_AC3))
2690             {
2691                 frameLength = 1536;
2692             }
2693             else if (sourceSelect == PAF_SOURCE_THD)
2694             {
2695                 frameLength = 1536; //QIN FIX ME
2696             }
2697             else
2698             {
2699                 frameLength = 256;
2700             }
2701 #endif    
2702             
2703             pAstCfg->xDec[z].decodeControl.frameLength = frameLength;
2704             pAstCfg->xDec[z].decodeInStruct.sampleCount = frameLength;
2705             pAstCfg->xDec[z].decodeControl.sampleRate = PAF_SAMPLERATE_UNKNOWN;
2706             
2707             // (***) FL: revisit. Count samples for DDP.
2708             // Add framework frame length and running sample count to decoder control.
2709             //pC->xDec[z].decodeControl.pafFrameLength = FRAMELENGTH;
2710             //pC->xDec[z].decodeControl.rdSampleCount = 0;
2712             // Initialize decoder output circular buffer for selected source
2713             errno = cbInitSourceSel(pCbCtl, z, sourceSelect, frameLength, FRAMELENGTH, 0);
2714             if (errno)
2715             {
2716                 SW_BREAKPOINT; // FL: debug
2717                 return errno;
2718             }
2719             // FL: debug
2720             cbLog(pCbCtl, z, 1, "PAF_ASIT_decodeInit:cbInitSourceSel");
2721             
2722             if (z != zMD) 
2723             {
2724                 if (errno = SIO_idle(pAstCfg->xInp[zI].hRxSio))
2725                 {
2726                     return errno;
2727                 }
2728             }
2730 #ifdef NON_CACHE_STATUS
2731             statusOp_read(&tempVar8,
2732                           &(pAstCfg->xDec[z].decodeStatus.sourceSelect),
2733                           sizeof(Int8),
2734                           GATEMP_INDEX_DEC);
2735             if (errno = SIO_ctrl(pAstCfg->xInp[zI].hRxSio, PAF_SIO_CONTROL_SET_SOURCESELECT,
2736                 DECSIOMAP(tempVar8)))
2737             {
2738                 return errno;
2739             }
2740 #else
2741             if (errno = SIO_ctrl(pAstCfg->xInp[zI].hRxSio, PAF_SIO_CONTROL_SET_SOURCESELECT,
2742                 DECSIOMAP(pAstCfg->xDec[z].decodeStatus.sourceSelect)))
2743             {
2744                 return errno;
2745             }
2746 #endif
2747             if (errno = SIO_ctrl(pAstCfg->xInp[zI].hRxSio, PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, 
2748                 frameLength))
2749             {
2750                 return errno;
2751             }
2752             if (errno = pP->fxns->updateInputStatus(pAstCfg->xInp[zI].hRxSio, &pAstCfg->xInp[zI].inpBufStatus, 
2753                 &pAstCfg->xInp[zI].inpBufConfig))
2754             {
2755                 return errno;
2756             }
2757         }
2758     }
2760     if (pAstCfg->xInp[zMI].hRxSio) 
2761     {
2762         errno = SIO_issue(pAstCfg->xInp[zMI].hRxSio, &pAstCfg->xInp[zMI].inpBufConfig,
2763             sizeof(pAstCfg->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME);
2764         if (errno)
2765         {
2766             return errno;
2767         }
2768     }
2770     return 0;
2771 } //PAF_AST_decodeInit
2773 // -----------------------------------------------------------------------------
2774 // ASIT Decoding Function - Info Processing, Common
2775 //
2776 //   Name:      PAF_ASIT_decodeInfo
2777 //   Purpose:   Decoding Function for processing information in a manner that
2778 //              is common for both initial and subsequent frames of input data.
2779 //   From:      AST Parameter Function -> decodeProcessing
2780 //   Uses:      See code.
2781 //   States:    x
2782 //   Return:    Error number in standard form (0 on success).
2783 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2784 //              * State information as per parent.
2785 //
2786 Int
2787 PAF_ASIT_decodeInfo(
2788     const PAF_ASIT_Params *pP, 
2789     const PAF_ASIT_Patchs *pQ, 
2790     PAF_ASIT_Config *pC, 
2791     Int frame, 
2792     Int block
2795     PAF_AST_Config *pAstCfg;
2796     Int as;                    /* Audio Stream Number (1, 2, etc.) */
2797     Int z;                     /* input/decode/stream counter */
2798     Int errno;                 /* error number */
2799     Int sioErr;                /* error number, SIO */
2800     Int zD, zI, zS, zX;
2801     Int zMD;
2802     Int zMI;
2803     Int zMS;
2804     UInt32 curTime;
2805     ASP_Msg *pAspMsg;          /* Messaging */
2806     Int argIdx;
2807     Int status;
2808 #ifdef NON_CACHE_STATUS
2809     Int8 tempVar8;
2810     Int tempVar;
2811 #endif
2812     // FL: revisit
2813     //Int size;
2814     //PAF_InpBufConfig *pIpBufConfig;
2816     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
2817     as = pAstCfg->as;
2818     zMD = pAstCfg->masterDec;
2819     zMS = pAstCfg->masterStr;
2820     zMI = pP->zone.master;
2821     (void)zMS;  (void)as;  // clear compiler warning in case not used with tracing disabled
2822     
2823     // Set decode control: sample rate, emphasis
2824     for (z=INPUT1; z < INPUTN; z++)
2825     {
2826         zD = z;
2827         for (zX = DECODE1; zX < DECODEN; zX++) 
2828         {
2829             if (pP->inputsFromDecodes[zX] == z) 
2830             {
2831                 zD = zX;
2832                 break;
2833             }
2834         }
2835 #ifdef PROFILER
2836             // modify for different sampling rate
2837             if (pAstCfg->xInp[z].inpBufStatus.sampleRateStatus == PAF_SAMPLERATE_96000HZ)
2838             {
2839                 start_profiling = 1;
2840             }
2841             else
2842             {
2843                 start_profiling = 0;
2844             }
2845 #endif
2846         if (pAstCfg->xInp[z].hRxSio) 
2847         {
2848             //determine associated decoder
2849             if (pAstCfg->xInp[z].inpBufStatus.sampleRateStatus != 
2850                 pAstCfg->xDec[zD].decodeControl.sampleRate) 
2851             {
2852                 if (pAstCfg->xDec[zD].decodeControl.sampleRate == PAF_SAMPLERATE_UNKNOWN) 
2853                 {
2854                     pAstCfg->xDec[zD].decodeControl.sampleRate = 
2855                         pAstCfg->xInp[z].inpBufStatus.sampleRateStatus;
2856                 }
2857                 else
2858                 {
2859                     TRACE_TERSE1("AS%d: return error ASPERR_INFO_RATECHANGE", as+pAstCfg->masterStr);
2860                     TRACE_TERSE2("inpBufStatus.sampleRateStatus: 0x%x, decodeControl.sampleRate: 0x%x",
2861                         pAstCfg->xInp[z].inpBufStatus.sampleRateStatus, 
2862                         pAstCfg->xDec[zD].decodeControl.sampleRate);
2863                     // return (ASPERR_INFO_RATECHANGE);
2864                 }
2865             }
2866 #ifdef NON_CACHE_STATUS
2867             statusOp_read(&tempVar8,
2868                           &(pAstCfg->xDec[zD].decodeStatus.sourceDecode),
2869                           sizeof(Int8),
2870                           GATEMP_INDEX_DEC);
2871             pAstCfg->xDec[zD].decodeControl.emphasis = 
2872                 tempVar8 != PAF_SOURCE_PCM
2873                 ? PAF_IEC_PREEMPHASIS_NO // fix for Mantis ID #119
2874                 : pAstCfg->xInp[z].inpBufStatus.emphasisStatus;
2875 #else
2876             pAstCfg->xDec[zD].decodeControl.emphasis =
2877                 pAstCfg->xDec[zD].decodeStatus.sourceDecode != PAF_SOURCE_PCM
2878                 ? PAF_IEC_PREEMPHASIS_NO // fix for Mantis ID #119
2879                 : pAstCfg->xInp[z].inpBufStatus.emphasisStatus;
2880 #endif
2881         }
2882         else 
2883         {
2884             pAstCfg->xDec[zD].decodeControl.sampleRate = PAF_SAMPLERATE_UNKNOWN;
2885             pAstCfg->xDec[zD].decodeControl.emphasis = PAF_IEC_PREEMPHASIS_UNKNOWN;
2886         }
2887     }
2889     // Wait for info input
2890     TRACE_VERBOSE2("PAF_ASIT_decodeInfo: AS%d: awaiting frame %d -- sync+info+data", as+zMS, frame);
2891     if (pAstCfg->xInp[zMI].hRxSio) 
2892     {
2893         TRACE_VERBOSE0("PAF_ASIT_decodeInfo: call SIO_reclaim to get input buffer.");
2894         sioErr = SIO_reclaim(pAstCfg->xInp[zMI].hRxSio, (Ptr)&pAstCfg->xInp[zMI].pInpBuf, NULL);
2895         if (sioErr != sizeof(pAstCfg->xInp[zMI].inpBufConfig))
2896         {
2897             TRACE_TERSE1("SIO_reclaim on input returned error ASPERR_RECLAIM.  sioErr: 0x%x", sioErr);
2898             return ASPERR_RECLAIM;
2899         }
2900         
2901         // FL: debug, capture input buffer
2902         capIb(pAstCfg->xInp[zMI].pInpBuf);
2903         gCapIb_cnt++;
2904