Build #49:Update tools submodule
[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 */
71 Int32 gNumPfpAsit1=0; // debug
72 Int32 gNumPfpAsit2=0;
76 // FL: debug
77 #include "dbgCapAf.h"
80 // -----------------------------------------------------------------------------
81 // Debugging Trace Control, local to this file.
82 // 
83 #include "logp.h"
85 #define TRACE_ARC(a)
87 // allows you to set a different trace module in pa.cfg
88 #define TR_MOD  trace
90 // Allow a developer to selectively enable tracing.
91 #define CURRENT_TRACE_MASK      0x21
93 #define TRACE_MASK_TERSE        0x01   // only flag errors and show init
94 #define TRACE_MASK_GENERAL      0x02   // half dozen lines per frame
95 #define TRACE_MASK_VERBOSE      0x04   // trace full operation
96 #define TRACE_MASK_DATA         0x08   // Show data
97 #define TRACE_MASK_TIME         0x10   // Timing related traces
98 #define TRACE_MASK_MSG          0x20   // Message related traces
100 #if !(CURRENT_TRACE_MASK & TRACE_MASK_TERSE)
101     #undef  TRACE_TERSE0
102     #undef  TRACE_TERSE1
103     #undef  TRACE_TERSE2
104     #undef  TRACE_TERSE3
105     #undef  TRACE_TERSE4
106     #define TRACE_TERSE0(a)
107     #define TRACE_TERSE1(a,b)
108     #define TRACE_TERSE2(a,b,c)
109     #define TRACE_TERSE3(a,b,c,d)
110     #define TRACE_TERSE4(a,b,c,d,e)
111 #endif
113 #if !(CURRENT_TRACE_MASK & TRACE_MASK_GENERAL)
114     #undef  TRACE_GEN0
115     #undef  TRACE_GEN1
116     #undef  TRACE_GEN2
117     #undef  TRACE_GEN3
118     #undef  TRACE_GEN4
119     #define TRACE_GEN0(a)
120     #define TRACE_GEN1(a,b)
121     #define TRACE_GEN2(a,b,c)
122     #define TRACE_GEN3(a,b,c,d)
123     #define TRACE_GEN4(a,b,c,d,e)
124 #endif
126 #if (CURRENT_TRACE_MASK & TRACE_MASK_VERBOSE)
127     // consolidate list of processing strings, indexed by PAF_SOURCE
128     static char *procName[] =
129     {
130         "", //PAF_SOURCE_UNKNOWN
131         "", //PAF_SOURCE_NONE
132         "AS%d: Pass processing ...",   //PAF_SOURCE_PASS
133         "AS%d: SNG processing ...",    //PAF_SOURCE_SNG
134         "AS%d: Auto processing ...",   //PAF_SOURCE_AUTO
135         "AS%d: Auto processing ...",   //PAF_SOURCE_BITSTREAM
136         "AS%d: DTS processing ...",    //PAF_SOURCE_DTSALL
137         "AS%d: PCM processing ...",    //PAF_SOURCE_PCMAUTO
138         "AS%d: PCM processing ...",    //PAF_SOURCE_PCM
139         "AS%d: PCN processing ...",    //PAF_SOURCE_PC8
140         "AS%d: AC3 processing ...",    //PAF_SOURCE_AC3
141         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS
142         "AS%d: AAC processing ...",    //PAF_SOURCE_AAC
143         "AS%d: MPG processing ...",    //PAF_SOURCE_MPEG
144         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS12
145         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS13
146         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS14
147         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS16
148         "AS%d: WMP processing ...",    //PAF_SOURCE_WMA9PRO
149         "AS%d: MP3 processing ...",    //PAF_SOURCE_MP3
150         "AS%d: DSD processing ...",    //PAF_SOURCE_DSD1
151         "AS%d: DSD processing ...",    //PAF_SOURCE_DSD2
152         "AS%d: DSD processing ...",    //PAF_SOURCE_DSD3
153         "AS%d: DDP processing ...",    //PAF_SOURCE_DDP
154         "AS%d: DTSHD processing ...",  //PAF_SOURCE_DTSHD
155         "AS%d: THD processing ...",    //PAF_SOURCE_THD
156         "AS%d: DXP processing ...",    //PAF_SOURCE_DXP
157         "AS%d: WMA processing ...",    //PAF_SOURCE_WMA
158     };
160 #else
161     #undef  TRACE_VERBOSE0
162     #undef  TRACE_VERBOSE1
163     #undef  TRACE_VERBOSE2
164     #undef  TRACE_VERBOSE3
165     #undef  TRACE_VERBOSE4
166     #define TRACE_VERBOSE0(a)
167     #define TRACE_VERBOSE1(a,b)
168     #define TRACE_VERBOSE2(a,b,c)
169     #define TRACE_VERBOSE3(a,b,c,d)
170     #define TRACE_VERBOSE4(a,b,c,d,e)
171 #endif
173 #if (CURRENT_TRACE_MASK & TRACE_MASK_DATA)
174     #define TRACE_DATA(a) LOG_printf a
175 #else
176     #define TRACE_DATA(a)
177 #endif
179 #if (CURRENT_TRACE_MASK & TRACE_MASK_TIME)
180     #define TRACE_TIME(a) LOG_printf a
181     #define TIME_MOD  trace // this could be different
182     static Int dtime()
183     {
184          static Int old_time = 0;
185          Int time = TSK_time();
186          Int delta_time = time - old_time;
187          old_time = time;
188          return( delta_time);
189     }
191     static char *stateName[11] =
192     {
193          "INIT",
194          "INFO1",
195          "AGAIN",
196          "INFO2",
197          "CONT",
198          "TIME",
199          "DECODE",
200          "STREAM",
201          "ENCODE",
202          "FINAL",
203          "QUIT"
204     };
206 #else
207     #define TRACE_TIME(a)
208 #endif
210 #if !(CURRENT_TRACE_MASK & TRACE_MASK_MSG)
211     #undef  TRACE_MSG0
212     #undef  TRACE_MSG1
213     #undef  TRACE_MSG2
214     #undef  TRACE_MSG3
215     #undef  TRACE_MSG4
216     #define TRACE_MSG0(a)
217     #define TRACE_MSG1(a,b)
218     #define TRACE_MSG2(a,b,c)
219     #define TRACE_MSG3(a,b,c,d)
220     #define TRACE_MSG4(a,b,c,d,e)
221 #endif
222     
224 // .............................................................................
226 #include <pafsio.h>
227 #include "paferr.h"
229 #include <acp_mds.h>
231 #include <pcm.h>
233 #include <pce.h>
235 #include <doberr.h>
237 #include <diberr.h>
239 #include <stdasp.h>
241 #include "as0.h"
242 #include "asperr.h"
244 #include "audioStreamProc_params.h"
245 #include "audioStreamProc_patchs.h"
246 #include "audioStreamProc_config.h"
247 #include "audioStreamInpProc.h"
250 #include "dbgBenchmark.h" // PCM high-sampling rate + SRC + CAR benchmarking
251 #ifdef _ENABLE_BENCHMARK_PCMHSR_SRC_CAR_
252 //
253 // Performing PCM high-sampling rate + SRC + CAR benchmarking
254 //
256 #define PROFILER
257 #endif
259 #ifdef PROFILER
260 extern UInt32 start_profiling;
261 #endif
263 extern UInt32 gAspProfileEnable;
265 //
266 // Audio Stream Definitions
267 //
269 // minimum audio frame "length" in samples (must be multiple of PA_MODULO)
270 #define MINFRAMELENGTH 24
271 #define PA_MODULO       8   // also defined independently in ARC2 code, and may be hard coded other places.
274 //
275 // Decoder Definitions
276 //
277 //#define decLinkInit pQ->i_decLinkInit
279 //
280 // Audio Stream Processing Definitions
281 //
282 //#define aspLinkInit pQ->i_aspLinkInit
284 //
285 // Encoder Definitions
286 //
287 #define encLinkInit pQ->i_encLinkInit
289 //
290 // Input, Output Definitions
291 //
292 #define inpLinkInit pP->i_inpLinkInit
293 //#define outLinkInit pP->i_outLinkInit
295 /* ---------------------------------------------------------------- */
296 /*              Parameter macro definitions end here.               */
297 /* ---------------------------------------------------------------- */
299 //
300 // Standardized Definitions
301 //
303 //#define DEC_Handle PCM_Handle /* works for all: SNG, PCM, AC3, DTS, AAC */
304 //#define ENC_Handle PCE_Handle /* works for all: PCE */
306 #define __TASK_NAME__  "TaskAsip"
308 LINNO_DEFN(TaskAsip); /* Line number macros */
309 ERRNO_DEFN(TaskAsip); /* Error number macros */
311 // ASIT configuration
312 #pragma DATA_SECTION(gPAF_ASIT_config, ".globalSectionPafAsitConfig")
313 PAF_ASIT_Config gPAF_ASIT_config = {
314     NULL,               // taskHandle
315     NULL,               // acp
316     &gPAF_ASPM_config,  // pAspmCfg, shared ASIT/ASOT configuration
317     &gPAF_AST_config    // pAstCfg, shared ASIT/ASOT/ASDT configuration
318 };
320 // Global debug counters */
321 UInt32 gTaskAsipCnt             =0;
322 UInt32 gAsipInitCnt             =0;
323 UInt32 gAsipInfo1Cnt            =0;
324 UInt32 gAsipInfo2Cnt            =0;
325 UInt32 gAsipDecodeCnt           =0;
326 UInt32 gAsipDecodeErrCnt        =0;
327 UInt32 gAsipFinalCnt            =0;
328 UInt32 gAsipQuitCnt             =0;
329 UInt32 gAsipInfo1_PrimaryErrCnt =0;
330 UInt32 gAsipInfo1_ErrCnt        =0;
331 UInt32 gAsipInfo2_PrimaryErrCnt =0;
332 UInt32 gAsipInfo2_ErrCnt        =0;
333 UInt32 gCapIbReset_cnt          =0;
334 UInt32 gCapIb_cnt               =0;
335 // debug
336 UInt32 gCbWrtAfErrCnt           =0; // decoder output circular buffer write error count (returned from ARM to DSP)
337                                    
339 #include "dbgDib.h" // debug
341 extern struct {
342     Int size;
343     IALG_Status *pStatus[512];
344 } IACP_STD_BETA_TABLE;
346 // FL: debug
347 #include "evmc66x_gpio_dbg.h"
349 /*
350  *  ======== taskAsipFxn ========
351  *  Audio Stream Input Processing task function
352  */
353 Void taskAsipFxn(
354 //    Int betaPrimeValue, // FL: revisit
355     const PAF_ASIT_Params *pP,
356     const PAF_ASIT_Patchs *pQ
359     PAF_ASIT_Config *pAsitCfg;      /* ASIT configuration pointer */
360     PAF_AST_Config *pAstCfg;        /* AST Common (shared) configuration pointer */
361     Int as;                         /* Audio Stream Number (1, 2, etc.) */
362     Int z;                          /* input/encode/stream/decode/output counter */
363     Int i;                          /* phase */
364     Int errno;                      /* error number */
365     Int zMD, zMI, zMS, zX;
366     Int loopCount = 0;  // used to stop trace to see startup behavior.        
367     UInt32 curTime;
368     Int size;
369     // Messaging
370     ASP_Msg *pAspMsg;              
371     Int status;
372 #ifdef NON_CACHE_STATUS
373     Int8 tempVar8;
374 #endif
376     Log_info0("Enter taskAsipFxn()");
378     //
379     // Audio Stream Input Task Parameters & Patch (*pP, *pQ)
380     //
381     if (!pP) 
382     {
383         TRACE_TERSE0("TaskAsip: No Parameters defined. Exiting.");
384         LINNO_RPRT(TaskAsip, -1);
385         return;
386     }
388     if (!pQ)
389     {
390         TRACE_TERSE0("TaskAsip: No Patchs defined. Exiting.");
391         LINNO_RPRT(TaskAsip, -1);
392         return;
393     }    
394     
395     //
396     // Audio Stream Input Task Configuration (*pAsitCfg):
397     //
398     pAsitCfg = &gPAF_ASIT_config;       // initialize pointer to task configuration
399     pAsitCfg->taskHandle = Task_self(); // set task handle
400     pAstCfg = pAsitCfg->pAstCfg;        // get pointer to AST common (shared) configuration
402     /* Set Audio Stream Number (1, 2, etc.) */
403     as = gBetaPrimeValue + 1;
404     pAstCfg->as = as;    
405     TRACE_TERSE1("TaskAsip: Started with AS%d.", as);
407     //
408     // Initialize message log trace and line number reporting
409     //
410     for (z=STREAM1; z < STREAMN; z++)
411     {
412         TRACE_TERSE1("TaskAsip: AS%d: initiated", as+z);
413     }
414     LINNO_RPRT(TaskAsip, -1);
415     
416     //
417     // Determine decoder and stream indices associated with the master input
418     //
419     zMI = pP->zone.master;
420     pAstCfg->masterDec = zMI;
421     pAstCfg->masterStr = zMI;
422     for (zX = DECODE1; zX < DECODEN; zX++)
423     {
424         if (pP->inputsFromDecodes[zX] == zMI)
425         {
426             pAstCfg->masterDec = zX;
427             pAstCfg->masterStr = pP->streamsFromDecodes[zX];
428             break;
429         }
430     }
431     zMD = pAstCfg->masterDec;
432     zMS = pAstCfg->masterStr;
434     // Initialize as per parametrized phases:
435     //
436     //   In standard form these are:
437     //      - Malloc: Memory Allocation
438     //      - Config: Configuration Initialization
439     //      - AcpAlg: ACP Algorithm Initialization and Local Attachment
440     //      - Common: Common Memory Initialization
441     //      - AlgKey: Dec/Enc chain to Array Initialization
442     //      - Device: I/O Device Initialization
443     //      - DecOpCircBuf: Decoder Output Circular Buffer
444     //      - Unused: (available)
445     //
446     LINNO_RPRT(TaskAsip, -2);
447     for (i=0; i < lengthof(pP->fxns->initPhase); i++)
448     {
449         Int linno;
450         if (pP->fxns->initPhase[i])
451         {
452             linno = pP->fxns->initPhase[i](pP, pQ, pAsitCfg);
453             if (linno) 
454             {
455                 LINNO_RPRT(TaskAsip, linno);
456                 return;
457             }
458         }
459         else 
460         {
461             TRACE_TERSE1("TaskAsip: AS%d: initialization phase - null", as+zMS);
462         }
463         TRACE_TERSE2("TaskAsip: AS%d: initialization phase - %d completed", as+zMS, i);
464         LINNO_RPRT(TaskAsip, -i-3);
465     }
467     //
468     // End of Initialization -- display memory usage report.
469     //
470     if (pP->fxns->memStatusPrint)
471     {
472         pP->fxns->memStatusPrint("ASIT MEMSTAT REPORT",
473             HEAP_INTERNAL, HEAP_INTERNAL1, HEAP_EXTERNAL, 
474             HEAP_INTERNAL1_SHM, HEAP_EXTERNAL_SHM, HEAP_EXTERNAL_NONCACHED_SHM);
475     }
476     
477     // (***) FL: revisit
478     // write back AST shared configuration
479     Cache_wb(pAstCfg, sizeof(PAF_AST_Config), Cache_Type_ALLD, 0);
480     Cache_wait();
482     // (***) FL: revisit
483     // write back Dec configuration
484     Cache_wb(&pAstCfg->xDec[0], DECODEN*sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
485     Cache_wait();
487     // (***) FL: revisit
488     // write back entire beta table
489     Cache_wb((Ptr)(&IACP_STD_BETA_TABLE.pStatus[0]), 512*sizeof(IALG_Status *), Cache_Type_ALLD, 0);
490     Cache_wait();
491     
492     // FL: send start initialization message to slave
493     pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize); /* allocate message */
494     MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
495     pAspMsg->cmd = ASP_SLAVE_START;                                                     /* fill in message payload */
496     pAspMsg->procId = hAspMsgMaster->masterProcId;
497     pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
498     pAspMsg->expectResp = TRUE;
499     TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
500     status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message */
501     if (status != MessageQ_S_SUCCESS)
502     {
503         SW_BREAKPOINT;
504     }
505     // wait for initialization complete message from slave
506     do {
507         //status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
508         status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, 0); // FL: no other thread is allowed to run until Slave finished startup
509     } while ((status != MessageQ_S_SUCCESS) || (pAspMsg->cmd != ASP_MASTER_START_DONE));
510     if ((pAspMsg->procId != hAspMsgMaster->slaveProcId) ||
511         (pAspMsg->cmd != ASP_MASTER_START_DONE) || 
512         (pAspMsg->messageId != (hAspMsgMaster->messageId | ((UInt32)1<<31))))
513     {
514         TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
515         SW_BREAKPOINT;
516     }
517     hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
518     TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
519     status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
520     if (status != MessageQ_S_SUCCESS)
521     {
522         SW_BREAKPOINT;
523     }
525     // (***) FL: revisit
526     // invalidate Status structure addresses for Beta Units initialized on Slave
527     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
528     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
529     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
530     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
531     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
532     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
533     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
534     Cache_wait();
535     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]) Log_info0("ERROR: beta unit for Dec==NULL");
536     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]) Log_info0("ERROR: beta unit for Dec==NULL");
537     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]) Log_info0("ERROR: beta unit for Dec==NULL");
538     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]) Log_info0("ERROR: beta unit for Dec==NULL");
539     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]) Log_info0("ERROR: beta unit for Dec==NULL");
540     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]) Log_info0("ERROR: beta unit for Dec==NULL");
541     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]) Log_info0("ERROR: beta unit for Dec==NULL");
542     
543     // (***) FL: revisit
544     // invalidate Status structures for Beta Units initialized on Slave
545     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), sizeof(Int), Cache_Type_ALLD, 0);
546     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]->size;
547     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), size, Cache_Type_ALLD, 0);
548     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), sizeof(Int), Cache_Type_ALLD, 0);
549     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]->size;
550     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), size, Cache_Type_ALLD, 0);
551     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]), sizeof(Int), Cache_Type_ALLD, 0);
552     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]->size;
553     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]), size, Cache_Type_ALLD, 0);
554     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), sizeof(Int), Cache_Type_ALLD, 0);
555     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]->size;
556     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), size, Cache_Type_ALLD, 0);
557     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]), sizeof(Int), Cache_Type_ALLD, 0);
558     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]->size;
559     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]), size, Cache_Type_ALLD, 0);
560     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]), sizeof(Int), Cache_Type_ALLD, 0);
561     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]->size;
562     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]), size, Cache_Type_ALLD, 0);
563     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]), sizeof(Int), Cache_Type_ALLD, 0);
564     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]->size;
565     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]), size, Cache_Type_ALLD, 0);
566     Cache_wait();
567     
568 #ifdef NON_CACHE_STATUS
569     // Get the shared status structure GateMP handles. Initialized at slave.
570     if (statusOp_Init(GATEMP_INDEX_DEC) == STATUSOP_INIT_FAIL)
571     {
572         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_DEC);
573     }
574     if (statusOp_Init(GATEMP_INDEX_DDP) == STATUSOP_INIT_FAIL)
575     {
576         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_DDP);
577     }
578     if (statusOp_Init(GATEMP_INDEX_PCM) == STATUSOP_INIT_FAIL)
579     {
580         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_PCM);
581     }
582     if (statusOp_Init(GATEMP_INDEX_THD) == STATUSOP_INIT_FAIL)
583     {
584         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_THD);
585     }
586 #endif
588     // (***) FL: revisit
589     // invalidate Dec configuration
590     Cache_inv(&gPAF_AST_config.xDec[0], DECODEN*sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
591     Cache_wait();
592     
593     //
594     // Main processing loop
595     //   
596     for (z=STREAM1; z < STREAMN; z++)
597     {
598         TRACE_VERBOSE1("TaskAsip: AS%d: running", as+z);
599     }
601     TRACE_TERSE0("TaskAsip: Entering Main Loop.");
602     
603     errno = 0;
604     for (;;)
605     {
606         Int sourceSelect;
607         XDAS_Int8 sourceProgram;
609         loopCount++;
611 #if 0   // enable and tune to see startup behavior.
612         // this is an alternative to fixed/circular setting in pa.cfg.
613         // If you are searching for a memory allocation failure, disable on first round.
614         // All allocation has already happened.
615         // This is the outer loop.  This loop count goes up when the stream resets.
616         // If the stream is running without problems, this does not increment.
617         // If the stream is repeatedly resetting, this loop count will go up rapidly.
618         if (loopCount > 10)  // see traces for a few of the passes through the main loop.
619         {
620              TRACE_TERSE1("TaskAsip: Trace stopped at loop %d.", loopCount);
621              LOG_disable(&TR_MOD);  // stop tracing
622         }
623 #endif
625         TRACE_GEN2("TaskAsip (begin Main loop %d) (errno 0x%x)", loopCount, errno);
626         TRACE_TIME((&TIME_MOD, "as1_f2... + %d = %d (begin Main loop)", dtime(), TSK_time()));
627         
628         // since not decoding indicate such
629         pP->fxns->sourceDecode(pP, pQ, pAsitCfg, PAF_SOURCE_NONE);
631         // any error forces idling of input
632         if (errno) 
633         {
634             for (z=INPUT1; z < INPUTN; z++)
635             {
636                 if (pAstCfg->xInp[z].hRxSio)
637                 {
638                     SIO_idle(pAstCfg->xInp[z].hRxSio);
639                 }
640             }
641         
642             TRACE_TERSE1("TaskAsip: Trace stopped at loop %d.", loopCount);
643             ERRNO_RPRT(TaskAsip, errno);
644         }
645         
646         // Execute a TSK_sleep to ensure that any non-blocking code paths are broken
647         // up to allow lower priority tasks to run. This may seem odd to be at the top
648         // of the state machine but provides for a cleaner flow even though the very
649         // first time we enter we do a sleep which is non-intuitive.
650         TRACE_VERBOSE1("TaskAsip: AS%d: ... sleeping ...", as+zMS);
651         TRACE_TIME((&TIME_MOD, "as1-f2... + %d = %d (begin SLEEP)", dtime(), TSK_time()));
652         Task_sleep(1);
654         TRACE_GEN1("TaskAsip: AS%d: Input device selection ...", as+zMS);
655         errno = pP->fxns->selectDevices(pP, pQ, pAsitCfg);
656         if (errno)
657         {
658             TRACE_TERSE2("TaskAsip: selectDevices returned errno = 0x%04x at line %d. AS%d", errno, as+zMS);
659             continue;
660         }
662         // if no master input selected then we don't know what may be at the input
663         // so set to unknown and skip any remaining processing
664         if (!pAstCfg->xInp[zMI].hRxSio)
665         {
666 #ifdef NON_CACHE_STATUS
667             tempVar8 = PAF_SOURCE_UNKNOWN;
668             statusOp_write(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram),
669                            &tempVar8,
670                            sizeof(tempVar8),
671                            GATEMP_INDEX_DEC);
672 #else
673             pAstCfg->xDec[zMD].decodeStatus.sourceProgram = PAF_SOURCE_UNKNOWN;
674 #endif
675             TRACE_VERBOSE1("TaskAsip: AS%d: No input selected...", as+zMS);
676             continue;
677         }
678         
679         // if here then we have a valid input so query its status
680         errno = pP->fxns->updateInputStatus(pAstCfg->xInp[zMI].hRxSio, &pAstCfg->xInp[zMI].inpBufStatus, &pAstCfg->xInp[zMI].inpBufConfig);
681         if (errno)
682         {
683             TRACE_VERBOSE1("TaskAsip: continue as updateInputStatus returns 0x%x", errno);
684             continue;
685         }
686         
687 #ifdef NON_CACHE_STATUS
688         statusOp_read(&tempVar8,
689                       &(pAstCfg->xDec[zMD].decodeStatus.mode),
690                       sizeof(tempVar8),
691                       GATEMP_INDEX_DEC);
692         // If master decoder is not enabled, or the input is unlocked, then do nothing
693         if (!tempVar8 || !pAstCfg->xInp[zMI].inpBufStatus.lock)
694         {
695             TRACE_VERBOSE0("TaskAsip: Not locked, continue");
696             continue;
697         }
698 #else
699         // If master decoder is not enabled, or the input is unlocked, then do nothing
700         if (!pAstCfg->xDec[zMD].decodeStatus.mode || !pAstCfg->xInp[zMI].inpBufStatus.lock)
701         {
702             TRACE_VERBOSE0("TaskAsip: Not locked, continue");
703             continue;
704         }
705 #endif
706         
707 #ifdef NON_CACHE_STATUS
708         statusOp_read(&tempVar8,
709                       &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
710                       sizeof(tempVar8),
711                       GATEMP_INDEX_DEC);
712         // If no source selected then do nothing
713         if (tempVar8 == PAF_SOURCE_NONE)
714         {
715             tempVar8 = PAF_SOURCE_NONE;
716             statusOp_write(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram),
717                            &tempVar8,
718                            sizeof(tempVar8),
719                            GATEMP_INDEX_DEC);
720             TRACE_VERBOSE1("TaskAsip: AS%d: no source selected, continue", as+zMS);
721             continue;
722         }
723 #else
724         // If no source selected then do nothing
725         if (pAstCfg->xDec[zMD].decodeStatus.sourceSelect == PAF_SOURCE_NONE) 
726         {
727             pAstCfg->xDec[zMD].decodeStatus.sourceProgram = PAF_SOURCE_NONE;
728             TRACE_VERBOSE1("TaskAsip: AS%d: no source selected, continue", as+zMS);
729             continue;
730         }
731 #endif
733 #ifdef NON_CACHE_STATUS
734         statusOp_read(&tempVar8,
735                       &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
736                       sizeof(tempVar8),
737                       GATEMP_INDEX_DEC);
738         // If we want pass processing then proceed directly
739         if (tempVar8 == PAF_SOURCE_PASS)
740         {
741             TRACE_VERBOSE1("TaskAsip: AS%d: Pass processing ...", as+zMS);
743             tempVar8 = PAF_SOURCE_PASS;
744             statusOp_write(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram),
745                            &tempVar8,
746                            sizeof(tempVar8),
747                            GATEMP_INDEX_DEC);
748 #else
749         // If we want pass processing then proceed directly
750         if (pAstCfg->xDec[zMD].decodeStatus.sourceSelect == PAF_SOURCE_PASS) 
751         {
752             TRACE_VERBOSE1("TaskAsip: AS%d: Pass processing ...", as+zMS);
753             pAstCfg->xDec[zMD].decodeStatus.sourceProgram = PAF_SOURCE_PASS;
754 #endif
755             pP->fxns->sourceDecode(pP, pQ, pAsitCfg, PAF_SOURCE_PASS);
756             if (pP->fxns->passProcessing)
757             {
758                 errno = pP->fxns->passProcessing(pP, pQ, pAsitCfg, NULL);                
759             }
760             else 
761             {
762                 TRACE_TERSE2("TaskAsip: AS%d: Pass Processing not supported, errno 0x%x", as+zMS, ASPERR_PASS);
763                 errno = ASPERR_PASS;
764             }
765             TRACE_VERBOSE0("TaskAsip: continue");
766             continue;
767         }
769 #ifdef NON_CACHE_STATUS
770         statusOp_read(&tempVar8,
771                       &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
772                       sizeof(tempVar8),
773                       GATEMP_INDEX_DEC);
774         // .....................................................................
775         // At this point we have an enabled input and want to decode something.
776         // If no decoder selected then do nothing. Need to reset the sourceProgram, since
777         // when no decoder is selected there are no calls to IB
778         //if (errno = pP->fxns->autoProcessing(pP, pQ, pC, pC->xDec[zMD].decodeStatus.sourceSelect, pC->xDec[zMD].decAlg[PAF_SOURCE_PCM]))
779         
780         pfpBegin(PFP_ID_ASIT_1, pAsitCfg->taskHandle);  // PFP begin
781         gNumPfpAsit1++;
782         errno = pP->fxns->autoProcessing(pP, pQ, pAsitCfg, tempVar8, NULL);
783         pfpEnd(PFP_ID_ASIT_1, PFP_FINISH_MEAS);         // PFP end
784         gNumPfpAsit1--;
786         if (errno) // (***) FL: re-visit this, hard-coded to use PCM framelength inside function
787         {
788             TRACE_VERBOSE1("TaskAsip: autoProcessing returns 0x%x, continue", errno);
789             continue;
790         }
791 #else
792         // .....................................................................
793         // At this point we have an enabled input and want to decode something.
794         // If no decoder selected then do nothing. Need to reset the sourceProgram, since
795         // when no decoder is selected there are no calls to IB
796         //if (errno = pP->fxns->autoProcessing(pP, pQ, PC, pC->xDec[zMD].decodeStatus.sourceSelect, pC->xDec[zMD].decAlg[PAF_SOURCE_PCM]))
797         if (errno = pP->fxns->autoProcessing(pP, pQ, pAsitCfg, pAstCfg->xDec[zMD].decodeStatus.sourceSelect, NULL)) // (***) FL: re-visit this, hard-coded to use PCM framelength inside function
798         {
799             TRACE_VERBOSE1("TaskAsip: autoProcessing returns 0x%x, continue", errno);
800             continue;
801         }
802 #endif
803         
804         // query for input type
805         errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_SOURCEPROGRAM, (Arg )&sourceProgram);
806         if (errno)
807         {
808             TRACE_TERSE2("TaskAsip: SIO_ctrl returns 0x%x, then 0x%x, continue", errno, ASPERR_AUTO_PROGRAM);
809             errno = ASPERR_AUTO_PROGRAM;
810             continue;
811         }
812 #ifdef NON_CACHE_STATUS
813         statusOp_write(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram),
814                       &(sourceProgram),
815                       sizeof(sourceProgram),
816                       GATEMP_INDEX_DEC);
817 #else
818         pAstCfg->xDec[zMD].decodeStatus.sourceProgram = sourceProgram;
819 #endif
821         // if input is unclassifiable then do nothing
822         if (sourceProgram == PAF_SOURCE_UNKNOWN)
823         {
824             TRACE_VERBOSE0("TaskAsip: Source program unknown. continue");
825             continue;
826         }
828         // now that we have some input classification, and possibly an outstanding
829         // input frame, we determine whether or not to call decodeProcessing and with
830         // what decAlg.
831         sourceSelect = PAF_SOURCE_NONE;
832 #ifdef NON_CACHE_STATUS
833         statusOp_read(&tempVar8,
834                       &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
835                       sizeof(tempVar8),
836                       GATEMP_INDEX_DEC);
837         switch (tempVar8)
838         {
839 #else
840         switch (pAstCfg->xDec[zMD].decodeStatus.sourceSelect) 
841         {
842 #endif
843             // If autodetecting, decoding everything, and input is something
844             // (i.e. bitstream or PCM) then decode.
845             case PAF_SOURCE_AUTO:
846                 if (sourceProgram >= PAF_SOURCE_PCM)
847                 {
848                     sourceSelect = sourceProgram;                    
849                 }
850                 break;
852             // If autodetecting, decoding only PCM, and input is PCM then decode.
853             case PAF_SOURCE_PCMAUTO:
854                 if (sourceProgram == PAF_SOURCE_PCM)
855                 {
856                     sourceSelect = sourceProgram;                    
857                 }
858                 break;
860             // If autodetecting, decoding only bitstreams, and input is a bitstream then decode.
861             case PAF_SOURCE_BITSTREAM:
862                 if (sourceProgram >= PAF_SOURCE_AC3)
863                 {
864                     sourceSelect = sourceProgram;                    
865                 }
866                 break;
868             // If autodetecting, decoding only DTS, and input is DTS then decode.
869             case PAF_SOURCE_DTSALL:
870                 switch (sourceProgram) 
871                 {
872                     case PAF_SOURCE_DTS11:
873                     case PAF_SOURCE_DTS12:
874                     case PAF_SOURCE_DTS13:
875                     case PAF_SOURCE_DTS14:
876                     case PAF_SOURCE_DTS16:
877                     case PAF_SOURCE_DTSHD:
878                         sourceSelect = sourceProgram;
879                         break;
880                 }
881                 break;
883             // All others, e.g., force modes, fall through to here.
884             // If user made specific selection then program must match select.
885             // (NB: this compare relies on ordering of PAF_SOURCE)
886             default:
887 #ifdef NON_CACHE_STATUS
888                 sourceSelect = 0; // due to size difference
889                 statusOp_read(&sourceSelect,
890                               &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
891                               sizeof(Int8),
892                               GATEMP_INDEX_DEC);
893 #else
894                 sourceSelect = pAstCfg->xDec[zMD].decodeStatus.sourceSelect;
895 #endif
896                 if ((sourceSelect >= PAF_SOURCE_PCM) && (sourceSelect <= PAF_SOURCE_N))
897                 {
898                     if (sourceProgram != sourceSelect)
899                     {
900                         sourceSelect = PAF_SOURCE_NONE;                        
901                     }
902                 }
903                 break;
904         }
906         // if we didn't find any matches then skip
907         if (sourceSelect == PAF_SOURCE_NONE)
908         {
909             TRACE_VERBOSE0("TaskAsip: no matching source type, continue");
910             continue;
911         }
913         // FL: debug, reset IB capture buffer
914         capIbReset();
915         gCapIbReset_cnt++;
916         Log_info0("capIbReset()");
918         // FL: send source select message to slave
919         pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize); /* allocate message */
920         MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
921         pAspMsg->cmd = ASP_SLAVE_DEC_SOURCE_SELECT;                                         /* fill in message payload */
922         pAspMsg->procId = hAspMsgMaster->masterProcId;
923         pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
924         pAspMsg->expectResp = TRUE;
925         *(Int32 *)&pAspMsg->buf[0] = sourceSelect;
926         TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
927         TRACE_MSG1("sourceSelect=%d", pAspMsg->buf[0]);
928         status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message */
929         if (status != MessageQ_S_SUCCESS)
930         {
931             SW_BREAKPOINT;
932         }
933         // wait for source select complete message from slave
934         //do {
935         //    status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
936         //} while (status != MessageQ_S_SUCCESS);
937         status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
938         if (status != MessageQ_S_SUCCESS)
939         {
940             TRACE_TERSE0("MessageQ_get() failure.");
941             SW_BREAKPOINT; // temporary
942         }
943         if ((pAspMsg->procId != hAspMsgMaster->slaveProcId) ||
944             (pAspMsg->cmd != ASP_MASTER_DEC_SOURCE_SELECT_DONE) ||
945             (pAspMsg->messageId != (hAspMsgMaster->messageId | ((UInt32)1<<31))))
946         {
947             TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
948             SW_BREAKPOINT;
949         }
950         hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
951         TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
952         status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
953         if (status != MessageQ_S_SUCCESS)
954         {
955             SW_BREAKPOINT;
956         }
957         
958         // set to unknown so that we can ensure, for IOS purposes, that sourceDecode = NONE
959         // iff we are in this top level state machine and specifically not in decodeProcessing
960         pP->fxns->sourceDecode(pP, pQ, pAsitCfg, PAF_SOURCE_UNKNOWN);
961         
962         TRACE_VERBOSE1(procName[sourceProgram], as+zMS);
964         // Reduce priority level since autodetection complete
965         Task_setPri(pAsitCfg->taskHandle, Task_getPri(pAsitCfg->taskHandle)-1);
966         
967         gAspProfileEnable=1; // enable ASP profiling
968         
969         TRACE_VERBOSE0("TaskAsip: calling decodeProcessing.");
970         errno = pP->fxns->decodeProcessing(pP, pQ, pAsitCfg, sourceSelect);
971         if (errno) 
972         {
973             TRACE_TERSE1("TaskAsip: decodeProcessing returns 0x%x, continue", errno);
974         }
975         else
976         {
977             TRACE_VERBOSE0("TaskAsip: decodeProcessing complete with no error.");
978         }        
980         gAspProfileEnable=0; // disable ASP profiling
981         
982         // Increase priority level since decoding complete
983         Task_setPri(pAsitCfg->taskHandle, Task_getPri(pAsitCfg->taskHandle)+1);
985         // FL: send dec exit message to slave
986         pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize); /* allocate message */
987         MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
988         pAspMsg->cmd = ASP_SLAVE_DEC_EXIT;                                                  /* fill in message payload */
989         pAspMsg->procId = hAspMsgMaster->masterProcId;
990         pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
991         pAspMsg->expectResp = TRUE;
992         TRACE_MSG2("Tx ASP message: procId=%d, cmd=%d.", pAspMsg->procId, pAspMsg->cmd);
993         status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message */
994         if (status != MessageQ_S_SUCCESS)
995         {
996             SW_BREAKPOINT;
997         }
998         // wait for dec exit complete message from slave
999         //do {
1000         //    status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
1001         //} while ((status < 0) || (pAspMsg->cmd != ASP_MASTER_DEC_EXIT_DONE));
1002         status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
1003         if (status != MessageQ_S_SUCCESS)
1004         {
1005             TRACE_TERSE0("MessageQ_get() failure.");
1006             SW_BREAKPOINT; // temporary
1007         }
1008         if ((pAspMsg->procId != hAspMsgMaster->slaveProcId) || 
1009             (pAspMsg->cmd != ASP_MASTER_DEC_EXIT_DONE) ||
1010             (pAspMsg->messageId != (hAspMsgMaster->messageId | ((UInt32)1<<31))))
1011         {
1012             TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
1013             SW_BREAKPOINT;
1014         }
1015         hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
1016         TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
1017         // free the message
1018         status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
1019         if (status != MessageQ_S_SUCCESS)
1020         {
1021             SW_BREAKPOINT;
1022         }
1023     } // End of main processing loop for (;;)
1024     
1025     Log_info0("Exit taskAsipFxn()");
1028 // -----------------------------------------------------------------------------
1029 // ASIT Initialization Function - Memory Allocation
1030 //
1031 //   Name:      PAF_ASIT_initPhaseMalloc
1032 //   Purpose:   Audio Stream Input Task Function for initialization of data pointers
1033 //              by allocation of memory.
1034 //   From:      audioStream1Task or equivalent
1035 //   Uses:      See code.
1036 //   States:    x
1037 //   Return:    0 on success.
1038 //              Source code line number on MEM_calloc failure.
1039 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1040 //              * State information as per parent.
1041 //              * Memory allocation errors.
1042 //
1043 Int
1044 PAF_ASIT_initPhaseMalloc(
1045     const PAF_ASIT_Params *pP, 
1046     const PAF_ASIT_Patchs *pQ, 
1047     PAF_ASIT_Config *pAsitCfg
1050     PAF_AST_Config *pAstCfg;
1051     Int as;                    /* Audio Stream Number (1, 2, etc.) */
1052     Int zMS;
1053     Error_Block    eb;
1055     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1056     as = pAstCfg->as;
1057     zMS = pAstCfg->masterStr;
1058     
1059     TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: initialization phase - memory allocation", as+zMS);
1061     // Initialize error block
1062     Error_init(&eb); 
1064     /* Input memory */
1065     if (!(pAstCfg->xInp = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, 
1066         INPUTN * sizeof (*pAstCfg->xInp), 4, &eb)))
1067     {
1068         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
1069         SW_BREAKPOINT;
1070         return __LINE__;
1071     }
1072     TRACE_TERSE3("PAF_ASIT_initPhaseMalloc. (pAstCfg->xInp) %d bytes from space %d at 0x%x.",
1073         INPUTN * sizeof (*pAstCfg->xInp),
1074         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xInp);
1076 #ifdef NON_CACHE_STATUS
1077     /* Decode memory */
1078     if (!(pAstCfg->xDec = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM,
1079         DECODEN * sizeof (*pAstCfg->xDec), 4, &eb)))
1080     {
1081         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
1082         SW_BREAKPOINT;
1083         return __LINE__;
1084     }
1085 #else
1086     /* Decode memory */
1087     if (!(pAstCfg->xDec = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, 
1088         DECODEN * sizeof (*pAstCfg->xDec), 4, &eb)))
1089     {
1090         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
1091         SW_BREAKPOINT;
1092         return __LINE__;
1093     }
1094 #endif
1095     TRACE_TERSE3("PAF_ASIT_initPhaseMalloc. (pAstCfg->xDec) %d bytes from space %d at 0x%x.",
1096         DECODEN * sizeof (*pAstCfg->xDec),
1097         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xDec);
1098                 
1099     TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: initialization phase - memory allocation complete.", as+zMS);
1100     return 0;
1101 } //PAF_ASIT_initPhaseMalloc
1103 // -----------------------------------------------------------------------------
1104 // ASIT Initialization Function - Memory Initialization from Configuration
1105 //
1106 //   Name:      PAF_ASIT_initPhaseConfig
1107 //   Purpose:   Audio Stream Task Function for initialization of data values
1108 //              from parameters.
1109 //   From:      audioStream1Task or equivalent
1110 //   Uses:      See code.
1111 //   States:    x
1112 //   Return:    0 on success.
1113 //              Other as per initFrame0 and initFrame1.
1114 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1115 //              * State information as per parent.
1116 //
1117 Int
1118 PAF_ASIT_initPhaseConfig(
1119     const PAF_ASIT_Params *pP, 
1120     const PAF_ASIT_Patchs *pQ, 
1121     PAF_ASIT_Config *pAsitCfg
1124     PAF_AST_Config *pAstCfg;
1125     Int as;                    /* Audio Stream Number (1, 2, etc.) */
1126     Int z;                     /* input/encode/stream/decode/output counter */
1127     Int zMS;
1129     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1130     as = pAstCfg->as;
1131     zMS = pAstCfg->masterStr;
1132     
1133     TRACE_TERSE1("PAF_ASIT_initPhaseConfig: AS%d: initialization phase - configuration", as+zMS);
1135     //
1136     // Unspecified elements have been initialized to zero during alloc
1137     //
1138     
1139     for (z=INPUT1; z < INPUTN; z++) 
1140     {
1141         pAstCfg->xInp[z].inpBufStatus = *pP->pInpBufStatus;
1142         pAstCfg->xInp[z].inpBufConfig.pBufStatus = &pAstCfg->xInp[z].inpBufStatus;
1143     }
1145     for (z=DECODE1; z < DECODEN; z++) 
1146     {
1147         Int zI = pP->inputsFromDecodes[z];
1148         pAstCfg->xDec[z].decodeControl.size = sizeof(pAstCfg->xDec[z].decodeControl);
1149         pAstCfg->xDec[z].decodeControl.pInpBufConfig = (const PAF_InpBufConfig *)&pAstCfg->xInp[zI].inpBufConfig;
1150         //pC->xDec[z].decodeStatus = *pP->z_pDecodeStatus[z]; // FL: slave
1151     }
1153     TRACE_TERSE1("PAF_ASIT_initPhaseConfig: AS%d: initialization phase - configuration complete.", as+zMS);
1154     return 0;
1155 } //PAF_ASIT_initPhaseConfig
1157 // -----------------------------------------------------------------------------
1158 // ASIT Initialization Function - ACP Algorithm Instantiation
1159 //
1160 //   Name:      PAF_ASIT_initPhaseAcpAlg
1161 //   Purpose:   Audio Stream Input Task Function for initialization of ACP by
1162 //              instantiation of the algorithm.
1163 //   From:      audioStream1Task or equivalent
1164 //   Uses:      See code.
1165 //   States:    x
1166 //   Return:    0 on success.
1167 //              Source code line number on ACP Algorithm creation failure.
1168 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1169 //              * State information as per parent.
1170 //              * Memory allocation errors.
1171 //
1172 Int
1173 PAF_ASIT_initPhaseAcpAlg(
1174     const PAF_ASIT_Params *pP, 
1175     const PAF_ASIT_Patchs *pQ, 
1176     PAF_ASIT_Config *pAsitCfg
1179     PAF_AST_Config *pAstCfg;
1180     Int as;                 /* Audio Stream Number (1, 2, etc.) */
1181     Int z;                  /* input/encode/stream/decode/output counter */
1182     Int betaPrimeOffset;
1183     ACP_Handle acp;
1184     Int zMS;
1185     Int zS, zX;
1187     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1188     as = pAstCfg->as;
1189     zMS = pAstCfg->masterStr;
1190     
1191     TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: initialization phase - ACP Algorithm", as+zMS);
1193     ACP_MDS_init();
1195     if (!(acp = (ACP_Handle)ACP_MDS_create(NULL))) 
1196     {
1197         TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: ACP algorithm instance creation failed", as+zMS);
1198         return __LINE__;
1199     }
1200     pAsitCfg->acp = acp;
1202     ((ALG_Handle)acp)->fxns->algControl((ALG_Handle) acp,
1203         ACP_GETBETAPRIMEOFFSET, (IALG_Status *)&betaPrimeOffset);
1205     for (z=INPUT1; z < INPUTN; z++) 
1206     {
1207         zS = z;
1208         for (zX = DECODE1; zX < DECODEN; zX++) 
1209         {
1210             if (pP->inputsFromDecodes[zX] == z) 
1211             {
1212                 zS = pP->streamsFromDecodes[zX];
1213                 break;
1214             }
1215         }
1216         acp->fxns->attach(acp, ACP_SERIES_STD,
1217             STD_BETA_IB + betaPrimeOffset * (as-1+zS),
1218             (IALG_Status *)&pAstCfg->xInp[z].inpBufStatus);
1219         /* Ignore errors, not reported. */
1220     }
1222     TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: initialization phase - ACP Algorithm complete.", as+zMS);
1224     return 0;
1225 } //PAF_ASIT_initPhaseAcpAlg
1227 // -----------------------------------------------------------------------------
1228 // ASIT Initialization Function - Common Memory
1229 //
1230 //   Name:      PAF_ASIT_initPhaseCommon
1231 //   Purpose:   Audio Stream Input Task Function for allocation of common memory.
1232 //   From:      audioStream1Task or equivalent
1233 //   Uses:      See code.
1234 //   States:    x
1235 //   Return:    0 on success.
1236 //              Source code line number on PAF_ALG_alloc failure.
1237 //              Source code line number on PAF_ALG_mallocMemory failure.
1238 //              Source code line number on Decode Chain initialization failure.
1239 //              Source code line number on ASP Chain initialization failure.
1240 //              Source code line number on Encode Chain initialization failure.
1241 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1242 //              * State information as per parent.
1243 //              * Memory allocation errors.
1244 //
1245 Int
1246 PAF_ASIT_initPhaseCommon(
1247     const PAF_ASIT_Params *pP, 
1248     const PAF_ASIT_Patchs *pQ, 
1249     PAF_ASIT_Config *pAsitCfg
1252     PAF_AST_Config *pAstCfg;
1253     Int as;                     /* Audio Stream Number (1, 2, etc.) */
1254     Int z;                      /* stream counter */
1255     ACP_Handle acp;
1256     PAF_IALG_Config pafAlgConfig;
1257     IALG_MemRec common[3][PAF_IALG_COMMON_MEMN+1];
1258    
1259     acp = pAsitCfg->acp;
1260     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1261     as = pAstCfg->as;
1262     
1263     TRACE_TERSE0("PAF_ASIT_initPhaseCommon: initialization phase - Common Memory");
1265     //
1266     // Determine memory needs and instantiate algorithms across audio streams
1267     //
1268     TRACE_TERSE0("PAF_ASIT_initPhaseCommon: calling PAF_ALG_setup.");
1269     PAF_ALG_setup(&pafAlgConfig, 
1270         HEAP_ID_INTERNAL,               HEAP_INTERNAL, 
1271         HEAP_ID_INTERNAL1,              HEAP_INTERNAL1, 
1272         HEAP_ID_EXTERNAL,               HEAP_EXTERNAL, 
1273         HEAP_ID_INTERNAL1_SHM,          HEAP_INTERNAL1_SHM, 
1274         HEAP_ID_EXTERNAL_SHM,           HEAP_EXTERNAL_SHM, 
1275         HEAP_ID_EXTERNAL_NONCACHED_SHM, HEAP_EXTERNAL_NONCACHED_SHM,
1276         HEAP_CLEAR);
1278     if (pP->fxns->headerPrint)
1279     {
1280         pP->fxns->headerPrint();        
1281     }
1283     for (z = STREAM1; z < STREAMN; z++) 
1284     {
1285         TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: initialization phase - Common Memory", as+z);
1287         //
1288         // Determine common memory for:
1289         //  (1) Logical Input drivers
1290         //
1291         // Decode Algorithms common memory determined in ASP Slave.
1292         //
1293         PAF_ALG_init(common[z], lengthof(common[z]), COMMONSPACE);
1295         //
1296         // Determine common memory needs of Logical Input driver
1297         //
1299         // really need to loop over all inputs for this stream using the tables
1300         // inputsFromDecodes and streamsFromDecodes. But these don't exist for this
1301         // patch, and not needed for FS11, since there is only one input.
1302         if (INPUT1 <= z && z < INPUTN) 
1303         {
1304             TRACE_TERSE2("PAF_ASIT_initPhaseCommon: AS%d: alloc inpLinkInit common[%d]", as+z, z);
1305             if (PAF_ALG_ALLOC(inpLinkInit[z-INPUT1], common[z]))
1306             {
1307                 TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: PAF_ALG_alloc failed", as+z);
1308                 TRACE_TERSE2("failed to alloc %d bytes from space %d", common[z]->size, (IArg)common[z]->space);
1309                 SW_BREAKPOINT;
1310                 return __LINE__;
1311             }
1312             TRACE_TERSE3("alloced %d bytes from space %d at 0x%x", common[z]->size, common[z]->space, (IArg)common[z]->base);
1313             if (pP->fxns->allocPrint)
1314             {
1315                 pP->fxns->allocPrint((const PAF_ALG_AllocInit *)(inpLinkInit[z-INPUT1]), sizeof (*(inpLinkInit[z-INPUT1])), &pafAlgConfig);
1316             }
1317         }
1318     }
1319     {
1320         // Changes made to share scratch between zones
1321         // Assume maximum 3 zones and scratch common memory is at offset 0;
1322         int max=0;
1323         for (z=STREAM1; z<STREAMN; z++)
1324         {
1325             if (max < common[z][0].size)
1326             {
1327                 max = common[z][0].size;
1328             }
1329         }
1330         common[STREAM1][0].size=max;
1331         for (z=STREAM1+1; z<STREAMN; z++)
1332         {
1333             common[z][0].size = 0;            
1334         }
1335     }
1336         
1337     //
1338     // Allocate common memory for:
1339     //  (1) Logical Input drivers
1340     //
1341     for (z = STREAM1; z < STREAMN; z++) 
1342     {
1343         TRACE_TERSE0("PAF_ASIT_initPhaseCommon: calling PAF_ALG_mallocMemory for common space.");
1344         if (PAF_ALG_mallocMemory(common[z], &pafAlgConfig)) 
1345         {
1346             TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: PAF_ALG_mallocMemory failed", as+z);
1347             TRACE_TERSE3("AS%d: z: %d.  Size 0x%x", as+z, z, common[z][0].size);
1348             SW_BREAKPOINT;
1349             return __LINE__;
1350         }
1351         TRACE_TERSE3("alloced %d bytes from space %d at 0x%x", common[z]->size, common[z]->space, (IArg)common[z]->base);
1352         // share zone0 scratch with all zones 
1353         common[z][0].base = common[0][0].base;
1354         if (pP->fxns->commonPrint)
1355         {
1356             pP->fxns->commonPrint(common[z], &pafAlgConfig);
1357         }
1359         //
1360         // Allocate non-common memories for Logical IO drivers
1361         //    Since these structures are used at run-time we allocate from external memory
1362         if (INPUT1 <= z && z < INPUTN) 
1363         {
1364             PAF_ASP_Chain *chain;
1365             TRACE_TERSE2("PAF_ASIT_initPhaseCommon: AS%d: non-common input chain init for %d",
1366                            as+z, z);
1367             chain = PAF_ASP_chainInit(&pAstCfg->xInp[z].inpChainData, pP->pChainFxns,
1368                         HEAP_EXTERNAL, as+z, acp, &trace,
1369                         inpLinkInit[z-INPUT1], NULL, common[z], &pafAlgConfig);
1370             if (!chain) 
1371             {
1372                 TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: Input chain initialization failed", as+z);
1373                 return __LINE__;
1374             }
1375         }
1376     }
1377     TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: Returning complete.", as+z);
1379     return 0;
1380 } //PAF_ASIT_initPhaseCommon
1382 // (***) FL: candidate for removal
1383 // -----------------------------------------------------------------------------
1384 // ASIT Initialization Function - Algorithm Keys
1385 //
1386 //   Name:      PAF_ASIT_initPhaseAlgKey
1387 //   Purpose:   Audio Stream Input Task Function for initialization of data values
1388 //              from parameters for Algorithm Keys.
1389 //   From:      audioStream1Task or equivalent
1390 //   Uses:      See code.
1391 //   States:    x
1392 //   Return:    0.
1393 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1394 //              * State information as per parent.
1395 //
1396 // .............................................................................
1397 Int
1398 PAF_ASIT_initPhaseAlgKey(
1399     const PAF_ASIT_Params *pP, 
1400     const PAF_ASIT_Patchs *pQ, 
1401     PAF_ASIT_Config *pAsitCfg
1404     PAF_AST_Config *pAstCfg;
1405     Int as;                    /* Audio Stream Number (1, 2, etc.) */
1407     
1408     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1409     as = pAstCfg->as;
1410     (void)as;  // clear compiler warning in case not used with tracing disabled
1412     TRACE_VERBOSE1("PAF_ASIT_initPhaseAlgKey: AS%d: initialization phase - Algorithm Keys", as);
1414 #if 0 // FL: slave    
1415     for (z=DECODE1; z < DECODEN; z++) 
1416     {
1417         for (s=0; s < pP->pDecAlgKey->length; s++) 
1418         {
1419             if ((pP->pDecAlgKey->code[s].full != 0) &&
1420                 (that = PAF_ASP_chainFind (&pC->xDec[z].decChainData, pP->pDecAlgKey->code[s]))) 
1421             {
1422                 pC->xDec[z].decAlg[s] = (ALG_Handle )that->alg;
1423                 /* Cast in interface, for now --Kurt */
1424             }
1425             else
1426             {
1427                 pC->xDec[z].decAlg[s] = NULL;
1428             }
1429         }
1430     }
1431 #endif
1433     return 0;
1434 } //PAF_ASIT_initPhaseAlgKey
1436 // -----------------------------------------------------------------------------
1437 // ASIT Initialization Function - I/O Devices
1438 //
1439 //   Name:      PAF_ASIT_initPhaseDevice
1440 //   Purpose:   Audio Stream Input Task Function for initialization of I/O Devices.
1441 //   From:      audioStream1Task or equivalent
1442 //   Uses:      See code.
1443 //   States:    x
1444 //   Return:    0 on success.
1445 //              Source code line number on device allocation failure.
1446 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1447 //              * State information as per parent.
1448 //              * Memory allocation errors.
1449 //
1450 Int
1451 PAF_ASIT_initPhaseDevice(
1452     const PAF_ASIT_Params *pP, 
1453     const PAF_ASIT_Patchs *pQ, 
1454     PAF_ASIT_Config *pAsitCfg
1457     PAF_AST_Config *pAstCfg;
1458     Int as;                             /* Audio Stream Number (1, 2, etc.) */
1459     Int z;                              /* input/output counter */
1460     PAF_SIO_IALG_Obj    *pObj;
1461     PAF_SIO_IALG_Config *pAlgConfig;
1462     PAF_IALG_Config pafAlgConfig;
1465     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1466     as = pAstCfg->as;
1467     (void)as; // clear compiler warning in case not used with tracing disabled
1469     TRACE_TERSE1("PAF_ASIT_initPhaseDevice: AS%d: initialization phase - I/O Devices", as);
1471     if (pP->fxns->bufMemPrint)
1472     {
1473         PAF_ALG_setup (&pafAlgConfig, 
1474             HEAP_ID_INTERNAL,               HEAP_INTERNAL, 
1475             HEAP_ID_INTERNAL1,              HEAP_INTERNAL1,
1476             HEAP_ID_EXTERNAL,               HEAP_EXTERNAL,
1477             HEAP_ID_INTERNAL1_SHM,          HEAP_INTERNAL1_SHM,
1478             HEAP_ID_EXTERNAL_SHM,           HEAP_EXTERNAL_SHM,
1479             HEAP_ID_EXTERNAL_NONCACHED_SHM, HEAP_EXTERNAL_NONCACHED_SHM,
1480             HEAP_CLEAR);
1481         TRACE_TERSE2("PAF_ASIT_initPhaseDevice: AS%d: calling PAF_ALG_setup with clear at %d.", as, HEAP_CLEAR);
1482     }
1484     for (z=INPUT1; z < INPUTN; z++) 
1485     {
1486         PAF_InpBufConfig *pConfig = &pAstCfg->xInp[z].inpBufConfig;
1488         pObj = (PAF_SIO_IALG_Obj *)pAstCfg->xInp[z].inpChainData.head->alg;
1489         pAlgConfig = &pObj->config;
1491         pAstCfg->xInp[z].hRxSio = NULL;
1493         pConfig->base.pVoid       = pAlgConfig->pMemRec[0].base;
1494         pConfig->pntr.pVoid       = pAlgConfig->pMemRec[0].base;
1495         pConfig->head.pVoid       = pAlgConfig->pMemRec[0].base;
1496         pConfig->futureHead.pVoid = pAlgConfig->pMemRec[0].base;
1497         pConfig->allocation       = pAlgConfig->pMemRec[0].size;
1498         pConfig->sizeofElement    = 2;
1499         pConfig->precision        = 16;
1501         if (pP->fxns->bufMemPrint)
1502         {
1503             pP->fxns->bufMemPrint(z, pAlgConfig->pMemRec[0].size, PAF_ALG_memSpaceToHeapId(&pafAlgConfig,pAlgConfig->pMemRec[0].space), 0);
1504         }
1505     }
1507     TRACE_TERSE1("PAF_ASIT_initPhaseDevice: AS%d: initialization phase - I/O Devices complete.", as);
1509     return 0;
1510 } //PAF_ASIT_initPhaseDevice
1512 // -----------------------------------------------------------------------------
1513 // ASIT Initialization Function - Decoder Output Circular Buffer
1514 //
1515 //   Name:      PAF_ASIT_initPhaseDecOpCircBuf
1516 //   Purpose:   Audio Stream Input Task Function for initialization of Decoder Output Circular Buffer.
1517 //   From:      audioStream1Task or equivalent
1518 //   Uses:      See code.
1519 //   States:    x
1520 //   Return:    0 on success.
1521 //              Source code line number on device allocation failure.
1522 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1523 //              * State information as per parent.
1524 //              * Memory allocation errors.
1525 //
1526 Int
1527 PAF_ASIT_initPhaseDecOpCircBuf(
1528     const PAF_ASIT_Params *pP, 
1529     const PAF_ASIT_Patchs *pQ, 
1530     PAF_ASIT_Config *pAsitCfg
1533     PAF_AST_Config *pAstCfg;
1534     PAF_AST_DecOpCircBuf *pCb;          /* Decoder output circular buffer */
1535     Int as;                             /* Audio Stream Number (1, 2, etc.) */
1536     Int zMS;
1537     Int z;                              /* decode counter */
1538     Int errno;                          /* error number */
1539     Error_Block    eb;
1540     Int i;
1542     // FL: (***)revisit
1543     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1544     as = pAstCfg->as;
1545     zMS = pAstCfg->masterStr;
1547     /* Decode output circular buffer memory */
1548     if (!(pAstCfg->xDecOpCb = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, 
1549         DECODEN * sizeof (*pAstCfg->xDecOpCb), 4, &eb)))
1550     {
1551         TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1552         SW_BREAKPOINT;
1553         return __LINE__;
1554     }
1556     TRACE_TERSE3("PAF_ASIT_initPhaseDecOpCircBuf. (pAsitCfg->xDecOpCb) %d bytes from space %d at 0x%x.",
1557         DECODEN * sizeof (*pAstCfg->xDecOpCb),
1558         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xDecOpCb);
1559         
1560     for (z=DECODE1; z < DECODEN; z++)
1561     {
1562         pCb = &pAstCfg->xDecOpCb[z];
1563         
1564         // allocate audio frame circular buffer
1565         if (!(pCb->afCb = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, ASP_DECOP_CB_MAX_NUM_AF * sizeof(PAF_AudioFrame), 4, &eb)))
1566         {
1567             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1568             SW_BREAKPOINT;
1569         }
1570         // allocate audio frame PCM sample pointer array
1571         for (i = 0; i<ASP_DECOP_CB_MAX_NUM_AF; i++)
1572         {
1573             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)))
1574             {
1575                 TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1576                 SW_BREAKPOINT;
1577             }
1578             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)))
1579             {
1580                 TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1581                 SW_BREAKPOINT;
1582             }                
1583         }
1584         // allocate PCM sample buffer
1585         if (!(pCb->pcmBuf = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_SHM, ASP_DECOP_CB_PCM_BUF_SZ * sizeof(PAF_AudioData), 4, &eb)))
1586         {
1587             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1588             SW_BREAKPOINT;
1589         }
1590         pCb->pcmBufEnd = pCb->pcmBuf + ASP_DECOP_CB_PCM_BUF_SZ;
1591         // allocate Metadata buffers
1592         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)))
1593         {
1594             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1595             SW_BREAKPOINT;
1596         }
1597         pCb->metaBufEnd = pCb->metaBuf + (ASP_DECOP_CB_MAX_NUM_AF * PAF_MAX_PRIVATE_MD_SZ * PAF_MAX_NUM_PRIVATE_MD);
1599         #ifdef CB_RW_OP_CAP_PP // debug
1600         // allocate debug buffer
1601         if (!(pCb->cb_samples_op = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, CB_OP_COUNT_MAX * sizeof(UInt32), 4, &eb)))
1602         {
1603             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1604             SW_BREAKPOINT;
1605         }
1607         // allocate debug buffer
1608         if (!(pCb->cb_op_owner = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, CB_OP_COUNT_MAX * sizeof(UInt8), 4, &eb)))
1609         {
1610             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1611             SW_BREAKPOINT;
1612         }
1614         // allocate debug buffer
1615         if (!(pCb->cb_afRdIdx = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, CB_OP_COUNT_MAX * sizeof(UInt8), 4, &eb)))
1616         {
1617             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1618             SW_BREAKPOINT;
1619         }
1621         // allocate debug buffer
1622         if (!(pCb->cb_afWrtIdx = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, CB_OP_COUNT_MAX * sizeof(UInt8), 4, &eb)))
1623         {
1624             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1625             SW_BREAKPOINT;
1626         }
1628         // allocate debug buffer
1629         if (!(pCb->cb_numAfCb = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, CB_OP_COUNT_MAX * sizeof(UInt8), 4, &eb)))
1630         {
1631             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1632             SW_BREAKPOINT;
1633         }
1634         #endif
1636         // (***) FL: revisit, here PCM is hard-coded for 256 sample dec op frame length        
1637         // Initialize decoder output circular buffer for PCM
1638         errno = cbInit(pCb);
1639         if (errno)
1640         {
1641             SW_BREAKPOINT; // FL: debug
1642             return errno;
1643         }
1644     }
1646     return 0;
1647 } //PAF_ASIT_initPhaseDecOpCircBuf
1650 #if 0
1651 // -----------------------------------------------------------------------------
1652 // AST Processing Function - Pass-Through Processing
1653 //
1654 //   Name:      PAF_AST_passProcessing
1655 //   Purpose:   Audio Stream Task Function for processing audio data as a
1656 //              pass-through from the input driver to the output driver
1657 //              for development and testing.
1658 //   From:      audioStream1Task or equivalent
1659 //   Uses:      See code.
1660 //   States:    x
1661 //   Return:    Error number in standard form (0 on success).
1662 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1663 //              * State information on initialization.
1664 //              * State information on processing.
1665 //
1667 #pragma CODE_SECTION(PAF_AST_passProcessing,".text:_PAF_AST_passProcessing")
1668 /* Pass Processing is often omitted from builds to save memory, */
1669 /* and CODE_SECTION/clink constructs facilitate this omission.  */
1671 Int
1672 PAF_AST_passProcessing(const PAF_AST_Params *pP, const PAF_AST_Patchs *pQ, PAF_AST_Config *pC, Int hack)
1674     Int z;                              /* input/output counter */
1675     Int errno = 0;                      /* error number */
1676     Int getVal;
1677     Int rxNumChan, txNumChan;
1678     Int first;
1679     Int zMD = pC->masterDec;
1680     Int zMI = pP->zone.master;
1683 #ifndef __TI_EABI__
1684     asm (" .clink"); /* See comment above regarding CODE_SECTION/clink. */
1685 #endif    
1687     TRACE_VERBOSE0("PAF_AST_passProcessing: initializing");
1689     //
1690     // Determine that receive/transmit channels are compatible
1691     //
1693     // Can handle handle only master input
1694     for (z=INPUT1; z < INPUTN; z++) {
1695         if (z != zMI && pC->xInp[z].hRxSio)
1696             return (ASPERR_PASS + 0x01);
1697     }
1699     /* Number of receive/transmit channels */
1701     if (! pC->xInp[zMI].hRxSio)
1702         return (ASPERR_PASS + 0x11);
1703     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &rxNumChan))
1704         return (ASPERR_PASS + 0x12);
1705     if (rxNumChan > NUM_TX_CHAN(zMI))
1706         return (ASPERR_PASS + 0x13);
1708     for (z=OUTPUT1; z < OUTPUTN; z++) {
1709         if (! pC->xOut[zMI].hTxSio)
1710             return (ASPERR_PASS + 0x10*(z+2) + 0x01);
1711         if (SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &txNumChan))
1712             return (ASPERR_PASS + 0x10*(z+2) + 0x02);
1713         if (txNumChan > NUM_TX_CHAN(zMI))
1714             return (ASPERR_PASS + 0x10*(z+2) + 0x03);
1715     }
1717     //
1718     // Set up receive/transmit
1719     //
1721     SIO_idle (pC->xInp[zMI].hRxSio);
1722     for (z=OUTPUT1; z < OUTPUTN; z++) {
1723         if(SIO_idle (pC->xOut[z].hTxSio))
1724             return ASPERR_IDLE;
1725     }
1727     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_SET_SOURCESELECT, PAF_SOURCE_PCM))
1728         return (ASPERR_PASS + 0x14);
1730     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, FRAMELENGTH))
1731         return (ASPERR_PASS + 0x15);
1733     for (z=OUTPUT1; z < OUTPUTN; z++)
1734         pC->xOut[z].outBufConfig.lengthofFrame = FRAMELENGTH;
1736     if (SIO_issue (pC->xInp[zMI].hRxSio, &pC->xInp[zMI].inpBufConfig, sizeof (pC->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_SYNC))
1737         return ASPERR_PASS + 0x16;
1739     if (SIO_reclaim (pC->xInp[zMI].hRxSio, (Ptr)&pC->xInp[zMI].pInpBuf, NULL) != sizeof (PAF_InpBufConfig))
1740         return ASPERR_PASS + 0x17;
1742     //
1743     // Receive and transmit the data in single-frame buffers
1744     //
1746     first = 1;
1747     while (pC->xDec[zMD].decodeStatus.sourceSelect == PAF_SOURCE_PASS) {
1748         PAF_OutBufConfig *pOutBuf;
1749         PAF_InpBufConfig *pInpBuf;
1751         if (first) {
1752             first = 0;
1754             TRACE_VERBOSE0("PAF_AST_passProcessing: starting output");
1756             for (z=OUTPUT1; z < OUTPUTN; z++) {
1757                 getVal = SIO_issue (pC->xOut[z].hTxSio, &pC->xOut[z].outBufConfig, sizeof(pC->xOut[z].outBufConfig), 0);
1758                 if (getVal > 0) {
1759                     errno = ASPERR_ISSUE;
1760                     break;
1761                 }
1762                 else if (getVal < 0) {
1763                     errno = -getVal;
1764                     break;
1765                 }
1767                 if (getVal = SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_UNMUTE, 0))
1768                     return (getVal & 0xff) | ASPERR_MUTE;
1769             }
1770             if (errno)
1771                 break;
1773         }
1775         getVal = SIO_issue (pC->xInp[zMI].hRxSio, &pC->xInp[zMI].inpBufConfig, sizeof (pC->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME);
1776         if (getVal > 0) {
1777             errno = ASPERR_ISSUE;
1778             break;
1779         }
1781         TRACE_VERBOSE1("PAF_AST_passProcessing: awaiting frame -- input size %d", rxNumChan * FRAMELENGTH);
1783         getVal = SIO_reclaim (pC->xInp[zMI].hRxSio, (Ptr) &pInpBuf, NULL);
1784         if (getVal < 0) {
1785             errno = -getVal;
1786             break;
1787         }
1789         for (z=OUTPUT1; z < OUTPUTN; z++) {
1790             getVal = SIO_reclaim (pC->xOut[z].hTxSio, (Ptr) &pOutBuf, NULL);
1791             if (getVal < 0) {
1792                 errno = -getVal;
1793                 break;
1794             }
1795         }
1796         if( errno )
1797             break;
1799         TRACE_VERBOSE0("PAF_AST_passProcessing: copying frame");
1801         if (errno = pP->fxns->passProcessingCopy (pP, pQ, pC))
1802             break;
1804         for (z=OUTPUT1; z < OUTPUTN; z++) {
1805             getVal = SIO_issue (pC->xOut[z].hTxSio, &pC->xOut[z].outBufConfig, sizeof(pC->xOut[z].outBufConfig), 0);
1806             if (getVal > 0) {
1807                 errno = ASPERR_ISSUE;
1808                 break;
1809             }
1810             else if (getVal < 0) {
1811                 errno = -getVal;
1812                 break;
1813             }
1814         }
1815         if( errno )
1816             break;
1817     }
1819     //
1820     // Close down receive/transmit
1821     //
1823     TRACE_TERSE0("PAF_AST_passProcessing: finalizing"));
1825     for (z=OUTPUT1; z < OUTPUTN; z++) {
1826         if (getVal = SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_MUTE, 0)) {
1827             if (! errno)
1828                 errno = (getVal & 0xff) | ASPERR_MUTE;
1829             /* convert to sensical errno */
1830         }
1831     }
1833     SIO_idle (pC->xInp[zMI].hRxSio);
1834     for (z=OUTPUT1; z < OUTPUTN; z++)
1835         SIO_idle (pC->xOut[z].hTxSio);
1837     return errno;
1839 } //PAF_AST_passProcessing
1840 #endif // #if 0
1842 #if 0
1843 // -----------------------------------------------------------------------------
1844 // AST Processing Function Helper - Pass-Through Processing Patch Point
1845 //
1846 //   Name:      PAF_AST_passProcessingCopy
1847 //   Purpose:   Pass-Through Processing Function for copying audio data
1848 //              from the input buffer to the output buffer.
1849 //   From:      AST Parameter Function -> passProcessing
1850 //   Uses:      See code.
1851 //   States:    x
1852 //   Return:    Error number in standard form (0 on success).
1853 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1854 //              x
1855 //
1857 #pragma CODE_SECTION(PAF_AST_passProcessingCopy,".text:_PAF_AST_passProcessingCopy")
1858 /* Pass Processing is often omitted from builds to save memory, */
1859 /* and CODE_SECTION/clink constructs facilitate this omission.  */
1861 Int
1862 PAF_AST_passProcessingCopy (const PAF_AST_Params *pP, const PAF_AST_Patchs *pQ, PAF_AST_Config *pC)
1864     Int z;                              /* output counter */
1865     Int errno;                          /* error number */
1866     Int i;
1867     Int rxNumChan, txNumChan;
1868     Int zMI = pP->zone.master;
1871     asm (" .clink"); /* See comment above regarding CODE_SECTION/clink. */
1873     // Copy data from input channels to output channels one of two ways:
1875     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &rxNumChan))
1876         return (ASPERR_PASS + 0x12);
1878     for (z=OUTPUT1; z < OUTPUTN; z++) {
1879         if (SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &txNumChan))
1880             return (ASPERR_PASS + 0x22);
1882         if( txNumChan <= rxNumChan ) {
1884             // Copy one to one, ignoring later rx channels as needed.
1886             for( i=0; i < txNumChan; i++ ) {
1887                 errno = pP->fxns->copy( i, &pC->xInp[zMI].inpBufConfig, i, &pC->xOut[z].outBufConfig );
1888                 if( errno )
1889                     return errno;
1890             }
1891         }
1892         else {
1894             // Copy one to many, repeating earlier rx channels as needed.
1896             Int from, to;
1898             from = 0;
1899             to   = 0;
1900             while( to < txNumChan ) {
1901                 errno = pP->fxns->copy( from, &pC->xInp[zMI].inpBufConfig, to, &pC->xOut[z].outBufConfig );
1902                 if( errno )
1903                     return errno;
1905                 from++;
1906                 to++;
1907                 if( from == rxNumChan )
1908                     from = 0;
1909             }
1910         }
1911     }
1913     return 0;
1914 } //PAF_AST_passProcessingCopy
1915 #endif // #if 0
1917 // -----------------------------------------------------------------------------
1918 // ASIT Processing Function - Auto Processing
1919 //
1920 //   Name:      PAF_ASIT_autoProcessing
1921 //   Purpose:   Audio Stream Input Task Function for processing audio data to
1922 //              determine the input type without output.
1923 //   From:      audioStream1Task or equivalent
1924 //   Uses:      See code.
1925 //   States:    x
1926 //   Return:    Error number in standard or SIO form (0 on success).
1927 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1928 //              * State information on initialization.
1929 //
1931 #define DECSIOMAP(X)                                                \
1932     pP->pDecSioMap->map[(X) >= pP->pDecSioMap->length ? 0 : (X)]
1934 Int
1935 PAF_ASIT_autoProcessing(
1936     const PAF_ASIT_Params *pP, 
1937     const PAF_ASIT_Patchs *pQ, 
1938     PAF_ASIT_Config *pAsitCfg, 
1939     Int inputTypeSelect, 
1940     ALG_Handle pcmAlgMaster
1943     PAF_AST_Config *pAstCfg;
1944     Int as;                 /* Audio Stream Number (1, 2, etc.) */
1945     Int errno = 0;          /* error number */
1946     Int nbytes;
1947     Int frameLength;
1948     Int zMD;
1949     Int zMI;
1950     Int zMS;
1951     
1952     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1953     as = pAstCfg->as;
1954     zMD = pAstCfg->masterDec;
1955     zMS = pAstCfg->masterStr;    
1956     zMI = pP->zone.master;    
1957     
1958     TRACE_VERBOSE1("PAF_ASIT_autoProcessing: AS%d: PAF_AST_autoProcessing", as+zMS);
1960     if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio,
1961                          PAF_SIO_CONTROL_SET_SOURCESELECT,
1962                          DECSIOMAP(pAstCfg->xDec[zMD].decodeStatus.sourceSelect)))
1963     {
1964         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: AS%d: source select returns 0x%x", as+zMS, errno);
1965         return errno;
1966     }
1967     //frameLength = pP->fxns->computeFrameLength (pcmAlgMaster, FRAMELENGTH,
1968     //                                            pC->xDec[zMD].decodeStatus.bufferRatio);
1969     frameLength = FRAMELENGTH; // FL: fix PCM frameLength for alpha release.
1971     if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio,
1972                          PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, frameLength))
1973     {
1974         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: SET_PCMFRAMELENGTH returns 0x%x, returning ASPERR_AUTO_LENGTH, 0x%x",
1975             errno, ASPERR_AUTO_LENGTH);
1976         return ASPERR_AUTO_LENGTH;
1977     }
1979     if (errno = SIO_issue(pAstCfg->xInp[zMI].hRxSio,
1980                           &pAstCfg->xInp[zMI].inpBufConfig, sizeof(pAstCfg->xInp[zMI].inpBufConfig),
1981                           PAF_SIO_REQUEST_SYNC))
1982     {
1983         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: REQUEST_SYNC returns 0x%x, returning ASPERR_ISSUE, 0x%x",
1984             errno, ASPERR_ISSUE);
1985         return ASPERR_ISSUE;
1986     }
1988     TRACE_VERBOSE1("PAF_ASIT_autoProcessing: AS%d: awaiting sync", as+zMS);
1990     // all of the sync scan work is done in this call. If the error returned
1991     // is DIBERR_SYNC then that just means we didn't find a sync, not a real I/O
1992     // error so we mask it off.
1993     nbytes = SIO_reclaim(pAstCfg->xInp[zMI].hRxSio, (Ptr)&pAstCfg->xInp[zMI].pInpBuf, NULL);
1994     if (nbytes == -DIBERR_SYNC)
1995     {
1996 #if 0 // (***) FL: shows timing of autosync restart
1997         // (***) debug // B5
1998         {
1999             static Uint8 toggleState = 0;
2000             if (toggleState == 0)
2001                 GPIOSetOutput(GPIO_PORT_0, GPIO_PIN_99);
2002             else
2003                 GPIOClearOutput(GPIO_PORT_0, GPIO_PIN_99);
2004             toggleState = ~(toggleState);
2005         }
2006 #endif                
2007         TRACE_TERSE2("PAF_ASIT_autoProcessing: AS%d: SIO_reclaim returned 0x%x, ignoring", as+zMS, nbytes);
2008         return nbytes;
2009     }
2010     if (nbytes != sizeof(PAF_InpBufConfig))
2011     {
2012         TRACE_TERSE3("PAF_ASIT_autoProcessing. SIO_reclaim returned %d, not %d, returning ASPERR_RECLAIM (0x%x)",
2013             nbytes, sizeof(PAF_InpBufConfig), ASPERR_RECLAIM);
2014         return ASPERR_RECLAIM;
2015     }
2016     if (errno)
2017     {
2018         TRACE_TERSE2("PAF_ASIT_autoProcessing: AS%d: returning errno 0x%x", as+zMS, errno);
2019     }
2020     return errno;
2021 } //PAF_ASIT_autoProcessing
2023 UInt32 gProbe1Err=0;
2024 UInt32 gProbe2Err=0;
2025 UInt32 gMajorAuMissed=0;
2027 // -----------------------------------------------------------------------------
2028 // ASIT Processing Function - Decode Processing
2029 //
2030 //   Name:      PAF_ASIT_decodeProcessing
2031 //   Purpose:   Audio Stream Input Task Function for processing audio data.
2032 //   From:      audioStream1Task or equivalent
2033 //   Uses:      See code.
2034 //   States:    x
2035 //   Return:    Error number in standard form (0 on success).
2036 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2037 //              * State information on initialization (via children).
2038 //              * State information on processing (via children).
2039 //              * Decode warnings.
2040 //
2041 // When "writeDECModeContinuous" is used for zMI input/decode:
2042 // PAF_AST_decodeProcessing() loop may be (is designed to be) exited:
2043 // (a) if "writeDECCommandRestart" is used
2044 //    (or "writeDECCommandAbort", but this performs no cleanup whatsoever, and so its use is discouraged)
2045 // (b) if "writeDECSourceSelectNone" is used
2046 // [ the latter events lead to QUIT state, simply for exiting (errme = errno = ASPERR_QUIT)
2047 // (c) if an error occurs in
2048 //     INIT
2049 //     CONT ("subsequent block state", which "Establish[es] secondary timing")
2050 //         -> PAF_AST_decodeCont(): "Await slave inputs"
2051 //     STREAM (errno |= PAF_COMPONENT_ASP)
2052 //     ENCODE (errno |= PAF_COMPONENT_ENCODE)
2053 // [ the latter errors lead to "switch_break:"
2054 //         -> PAF_AST_decodeComplete(), which always returns 0 (no error) ]
2055 //
2056 // [ Notably, in FINAL ("frame-finalization state")
2057 //         -> PAF_AST_decodeFinalTest() is *not* called,
2058 //   and so any other (asynchronous) changes in pC->xDec[zMD].decodeStatus.sourceSelect are ignored. ]
2059 // [ For completeness, note also: "default" state, internal check (errme = errno = ASPERR_UNKNOWNSTATE) ]
2060 //
2061 // States in which error can't occur:
2062 //     AGAIN ("subsequent initial state")
2063 //
2064 // States in which (some) errors must be handled:
2065 //     INFO1 ("first frame state")
2066 //         -> PAF_AST_decodeInfo(): pass on ASPERR_INFO_RATECHANGE, ASPERR_INFO_PROGRAM ("bad" internal error)
2067 //            -> *DONE* must "catch" ASPERR_RECLAIM from SIO_reclaim (pC->xInp[zMI].hRxSio) -- note zMI only **
2068 //               ?*? but what about ASPERR_RESYNC from same call ?*?
2069 //            -> *for now, at least, pass on error from pP->fxns->updateInputStatus ()*
2070 //            -> *DONE* must "catch" error from (zMI) dec->fxns->info() **
2071 //         -> PAF_AST_decodeInfo1(): pass on any errors which occur here:
2072 //            - pP->fxns->streamChainFunction (... PAF_ASP_CHAINFRAMEFXNS_RESET)
2073 //            - enc->fxns->info()
2074 //            - pP->fxns->setCheckRateX()
2075 //            - pP->fxns->startOutput()
2076 //            - "Start slave inputs if necessary"
2077 //     INFO2 ("subsequent frame state")
2078 //         -> PAF_AST_decodeInfo(): (see above)
2079 //         -> PAF_AST_decodeInfo2(): pass on any errors which occur here:
2080 //            - pP->fxns->setCheckRateX()
2081 //     TIME ("timing state")
2082 //         -> PAF_AST_decodeTime(): "Special timing consideations for AC-3"
2083 //         -> performs SIO_issue (... PAF_SIO_REQUEST_FULLFRAME) & SIO_reclaim() *for zMI only*
2084 //         -> now, DIB_issue [PAF_SIO_REQUEST_FULLFRAME] would only return SYS_EINVAL for "bad" internal error
2085 //            (*OK* don't try to recover from this*)
2086 //         -> much more likely would be SIO_reclaim() error (ASPERR_RECLAIM)
2087 //         -> *DONE* must "catch" (just) ASPERR_RECLAIM error -- note zMI only,
2088 //            possibly in PAF_AST_decodeProcessing() itself **
2089 //     DECODE ("decode state")
2090 //         -> PAF_AST_decodeDecode(): pass on error from
2091 //            - PAF_SIO_CONTROL_GET_NUM_REMAINING ("bad" internal error)
2092 //            - dec->fxns->reset()
2093 //            - PAF_SIO_CONTROL_SET_PCMFRAMELENGTH
2094 //         -> *DONE* must catch error from (zMI) dec->fxns->decode()
2095 //         -> *?* must catch ASPERR_ISSUE from (zMI) SIO_issue()
2096 Int
2097 PAF_ASIT_decodeProcessing(
2098     const PAF_ASIT_Params *pP, 
2099     const PAF_ASIT_Patchs *pQ, 
2100     PAF_ASIT_Config *pAsitCfg, 
2101     Int sourceSelect
2104     PAF_AST_Config *pAstCfg;
2105     //Int as = pAsitCfg->as;              /* Audio Stream Number (1, 2, etc.) */
2106     Int z;                              /* decode counter */
2107     Int errno;                          /* error number */
2108     Int getVal;
2109     enum { INIT, INFO1, INFO2, DECODE, FINAL, QUIT } state;
2110     ALG_Handle alg[DECODEN_MAX];
2111     Int zMD;
2112     Int zMS;
2113     Int size;
2114     //PAF_InpBufConfig *pIpBufConfig;
2115     Int frame; // decoder input frame count
2116     Int block; // (***) FL: formerly  -- decoder output block count / input frame
2117 #ifdef NON_CACHE_STATUS
2118     Int8 tempVar8, temp2Var8;
2119 #endif
2120     
2121     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
2122     zMD = pAstCfg->masterDec;
2123     zMS = pAstCfg->masterStr;
2124         
2125     for (z=DECODE1; z < DECODEN; z++)
2126     {
2127         alg[z] = pAstCfg->xDec[z].decAlg[PAF_SOURCE_PCM];        
2128     }
2129     alg[zMD] = NULL; // decAlgMaster; // FL: alg[] init is on slave
2131     //
2132     // Receive and process the data in single-frame buffers
2133     //
2135     state = INIT;
2136     errno = 0; /* error number */
2138 #ifdef NON_CACHE_STATUS
2139     statusOp_read(&tempVar8,
2140                   &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
2141                   sizeof(tempVar8),
2142                   GATEMP_INDEX_DEC);
2143     TRACE_TERSE1("PAF_ASIT_decodeProcessing: sourceSelect is %d", tempVar8);
2145     for (;;) 
2146     {
2147         statusOp_read(&tempVar8,
2148                       &(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
2149                     sizeof(tempVar8),
2150                     GATEMP_INDEX_DEC);
2151         if (tempVar8 == PAF_SOURCE_NONE)
2152         {
2153 #else
2154     TRACE_TERSE1("PAF_ASIT_decodeProcessing: sourceSelect is %d", pAstCfg->xDec[zMD].decodeStatus.sourceSelect);
2156     for (;;)
2157     {
2158         if (pAstCfg->xDec[zMD].decodeStatus.sourceSelect == PAF_SOURCE_NONE)
2159         {
2160 #endif
2161             TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: sourceSelect == PAF_SOURCE_NONE");
2162             state = QUIT;
2163         }
2165         // Process commands (decode)
2166         getVal = pP->fxns->decodeCommand(pP, pQ, pAsitCfg);
2167         if (getVal) 
2168         {
2169             if (state != INIT)   // no need to restart/abort if not yet started
2170             {
2171                 if (getVal == ASPERR_QUIT)
2172                 {
2173                     state = QUIT;
2174                     TRACE_VERBOSE0("PAF_ASIT_decodeProcessing. %d: state = QUIT");
2175                 }
2176                 else if (getVal == ASPERR_ABORT)
2177                 {
2178                     TRACE_VERBOSE0("PAF_ASIT_decodeProcessing. %d: return getVal");
2179                     
2180                     // PFP end -- outside of PFP for errors, EOS, or Input SIO change
2181                     pfpEnd(PFP_ID_ASIT_2, PFP_FINISH_MEAS);
2182                     gNumPfpAsit2--;
2183                     
2184                     return getVal;
2185                 }
2186                 else
2187                 {
2188                     /* ignore */;
2189                 }
2190             }
2191             TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state == INIT");
2192         }
2194         TRACE_TIME((&TIME_MOD,         "... + %d = %d ->", dtime(), TSK_time()));
2195         TRACE_TIME((&TIME_MOD,         "                 state = %s", stateName[state]));
2197         // Process state (decode)
2198         switch (state) 
2199         {
2200             case INIT: // initial state
2201                 gAsipInitCnt++;
2202                 Log_info0("TaskAsip: state=INIT");               
2204                 errno = pP->fxns->decodeInit(pP, pQ, pAsitCfg, sourceSelect);
2205                 if (errno)
2206                 {
2207                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INIT, errno 0x%x.  break after decodeInit", errno);
2208                     break;
2209                 }
2210                                
2211                 frame = 0;
2212                 block = 0;
2214                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INIT->INFO1");
2215                 state = INFO1;
2216                 continue;
2218             case INFO1: // first frame state
2219                 gAsipInfo1Cnt++;
2220                 Log_info0("TaskAsip: state=INFO1");
2221                 
2222                 // Establish primary timing
2223                 errno = pP->fxns->decodeInfo(pP, pQ, pAsitCfg, frame, block);
2224                 if (errno)
2225                 {
2226                     gAsipInfo1_PrimaryErrCnt++;
2227                     TRACE_TERSE1("INFO1: errno 0x%x after decodeInfo, primary timing", errno);
2228                     break;
2229                 }
2230                 
2231 #ifdef NON_CACHE_STATUS
2232                 statusOp_read(&tempVar8,
2233                               &(pAstCfg->xDec[zMD].decodeStatus.sourceDecode),
2234                               sizeof(tempVar8),
2235                               GATEMP_INDEX_DEC);
2236                 statusOp_read(&temp2Var8,
2237                               &(pAstCfg->xDec[zMD].decodeStatus.sampleRate),
2238                               sizeof(tempVar8),
2239                               GATEMP_INDEX_DEC);
2240                 // Don't start decode until major access unit is found.
2241                 if (((tempVar8 == PAF_SOURCE_THD)    ||
2242                      (tempVar8 == PAF_SOURCE_DXP)    ||
2243                      (tempVar8 == PAF_SOURCE_DTSHD)) &&
2244                      (temp2Var8 == PAF_SAMPLERATE_UNKNOWN)) 
2245 #else
2246                 // Don't start decode until major access unit is found.
2247                 if (((pAstCfg->xDec[zMD].decodeStatus.sourceDecode == PAF_SOURCE_THD)    ||
2248                      (pAstCfg->xDec[zMD].decodeStatus.sourceDecode == PAF_SOURCE_DXP)    ||
2249                      (pAstCfg->xDec[zMD].decodeStatus.sourceDecode == PAF_SOURCE_DTSHD)) &&
2250                      (pAstCfg->xDec[zMD].decodeStatus.sampleRate == PAF_SAMPLERATE_UNKNOWN))
2251 #endif
2252                 {
2253                     Int z;
2254                     for (z=DECODE1; z < DECODEN; z++) 
2255                     {
2256                         Int zI = pP->inputsFromDecodes[z];
2257 #ifdef NON_CACHE_STATUS
2258                         statusOp_read(&tempVar8,
2259                                       &(pAstCfg->xDec[z].decodeStatus.mode),
2260                                       sizeof(tempVar8),
2261                                       GATEMP_INDEX_DEC);
2262                         if (pAstCfg->xInp[zI].hRxSio && tempVar8)
2263                         {
2264 #else
2265                         if (pAstCfg->xInp[zI].hRxSio && pAstCfg->xDec[z].decodeStatus.mode)
2266                         {
2267 #endif
2268                             TRACE_VERBOSE0("TaskAsip: PAF_ASIT_decodeProcessing: INFO1, SIO_issue");
2269                             if (SIO_issue(pAstCfg->xInp[zI].hRxSio, &pAstCfg->xInp[zI].inpBufConfig,
2270                                 sizeof(pAstCfg->xInp[zI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME))
2271                             {
2272                                 gProbe2Err++;
2273                                 TRACE_TERSE0("PAF_ASIT_decodeProcessing. %d: INFO1, return (ASPERR_ISSUE)");
2274                                 
2275                                 // PFP end -- outside of PFP for errors, EOS, or Input SIO change
2276                                 pfpEnd(PFP_ID_ASIT_2, PFP_FINISH_MEAS);
2277                                 gNumPfpAsit2--;
2278                                 
2279                                 return (ASPERR_ISSUE);
2280                             }
2281                         }
2282                     }
2283                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1: frame %d, not major access unit", frame);
2284                     gMajorAuMissed++; // debug
2285                     frame++;
2286                     state = INFO1;
2287                     continue;
2288                 }
2289                 TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1: frame %d, major access unit found", frame);
2291                 // Establish secondary timing
2292                 errno = pP->fxns->decodeInfo1(pP, pQ, pAsitCfg, frame, block);
2293                 if (errno)
2294                 {
2295                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1, errno 0x%x.  break after decodeInfo1", errno);
2296                     gAsipInfo1_ErrCnt++;
2297                     break;
2298                 }
2300                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INFO1->DECODE");
2301                 state = DECODE;
2302                 continue;
2304             case INFO2: // subsequent frame state
2305                 gAsipInfo2Cnt++;
2306                 Log_info0("TaskAsip: state=INFO2");
2308                 // Establish primary timing
2309                 errno = pP->fxns->decodeInfo(pP, pQ, pAsitCfg, frame, block);
2310                 if (errno)
2311                 {
2312                     TRACE_TERSE1("PAF_ASIT_decodeProcessing: INFO2 break on decodeInfo. errno 0x%x", errno);
2313                     gAsipInfo2_PrimaryErrCnt++;
2314                     break;
2315                 }
2316                                 
2317                 // Measure cycles in decode processing loop.
2318                 // Only measures cycles spent in loop.
2319                 pfpEnd(PFP_ID_ASIT_2, PFP_FINISH_MEAS);         // PFP end
2320                 gNumPfpAsit2--;
2321                 pfpBegin(PFP_ID_ASIT_2, pAsitCfg->taskHandle);  // PFP begin
2322                 gNumPfpAsit2++;
2324                 errno = pP->fxns->decodeInfo2(pP, pQ, pAsitCfg, frame, block);
2325                 if (errno)
2326                 {
2327                     TRACE_TERSE1("PAF_ASIT_decodeProcessing. %d: INFO2 break on decodeInfo2. errno 0x%x", errno);
2328                     gAsipInfo2_ErrCnt++;
2329                     break;
2330                 }
2331                
2332                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INFO2->DECODE");
2333                 state = DECODE;
2334                 continue;
2336             case DECODE: // decode state
2337                 gAsipDecodeCnt++;
2338                 Log_info0("TaskAsip: state=DECODE");
2340                 errno = pP->fxns->decodeDecode(pP, pQ, pAsitCfg, sourceSelect, frame, block);
2341                 if (errno)
2342                 {
2343                         gAsipDecodeErrCnt++;
2344                         TRACE_TERSE1("PAF_ASIT_decodeProcessing: state: DECODE.  decodeDecode err 0x%04x", errno);
2345                     break;
2346                 }
2347                 
2348                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: DECODE->FINAL");
2349                 state = FINAL;
2350                 continue;
2352             case FINAL: // frame-finalization state
2353                 gAsipFinalCnt++;
2354                 Log_info0("TaskAsip: state=FINAL");
2356                 // Check for final frame, and if indicated:
2357                 // - Exit state machine to "complete" processing.
2358                 if (pP->fxns->decodeFinalTest(pP, pQ, pAsitCfg, frame, block)) 
2359                 {
2360                     break;
2361                 }
2363                 frame++;
2364                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: FINAL->AGAIN");
2365                 state = INFO2;
2366                 continue;
2368             case QUIT: // exit state
2369                 gAsipQuitCnt++;
2370                 Log_info0("TaskAsip: state=QUIT");
2372                 // Quit:
2373                 // - Set error number registers.
2374                 // - Exit state machine to "decode complete" processing.
2375                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: QUIT");
2376                 errno = ASPERR_QUIT;
2377                 break;
2379             default: // unknown state
2381                 // Unknown:
2382                 // - Set error number registers.
2383                 // - Exit state machine to "decode complete" processing.
2385                 TRACE_TERSE1("PAF_ASIT_decodeProcessing: state: unknown, 0x%x", state);
2386                 errno = ASPERR_UNKNOWNSTATE;
2387                 break;
2389         }  // End of switch (state).
2391         TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: Calling decode complete");
2392         if (pP->fxns->decodeComplete(pP, pQ, pAsitCfg, alg, frame, block))
2393         {
2394             /* ignored? */;
2395         }
2396         
2397         TRACE_TIME((&TIME_MOD, "as1-f2: ... + %d = ?? (final? %d)", dtime(), state == FINAL));
2399         // PFP end -- outside of PFP for errors, EOS, or Input SIO change
2400         //pfpEnd(PFP_ID_ASIT_2, PFP_FINISH_MEAS);
2401         //gNumPfpAsit2--;
2402         
2403         //return errno;
2404         break;
2405     }  // End of for (;;) to Receive, process, and transmit the data.
2406     
2407     // PFP end -- outside of PFP for errors, EOS, or Input SIO change
2408     pfpEnd(PFP_ID_ASIT_2, PFP_FINISH_MEAS);
2409     gNumPfpAsit2--;
2410     
2411     return errno;
2412 } //PAF_ASIT_decodeProcessing
2414 // -----------------------------------------------------------------------------
2415 // ASIT Decoding Function - Decode Command Processing
2416 //
2417 //   Name:      PAF_ASIT_decodeCommand
2418 //   Purpose:   Decoding Function for processing Decode Commands.
2419 //   From:      AST Parameter Function -> decodeProcessing
2420 //   Uses:      See code.
2421 //   States:    x
2422 //   Return:    Error number in standard form (0 on success).
2423 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2424 //              * Command execution.
2425 //
2427 Int
2428 PAF_ASIT_decodeCommand(
2429     const PAF_ASIT_Params *pP, 
2430     const PAF_ASIT_Patchs *pQ, 
2431     PAF_ASIT_Config *pAsitCfg
2434     PAF_AST_Config *pAstCfg;
2435     Int as;                 /* Audio Stream Number (1, 2, etc.) */
2436     Int z;                  /* decode counter */
2437     Int zS;
2438 #ifdef NON_CACHE_STATUS
2439     Int8 tempVar8;
2440 #endif
2442     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
2443     as = pAstCfg->as;
2445     for (z=DECODE1; z < DECODEN; z++) 
2446     {
2447         zS = pP->streamsFromDecodes[z];
2448 #ifdef NON_CACHE_STATUS
2449         statusOp_read(&tempVar8,
2450                       &(pAstCfg->xDec[z].decodeStatus.command2),
2451                       sizeof(tempVar8),
2452                       GATEMP_INDEX_DEC);
2453         if (!(tempVar8 & 0x80))
2454         {
2455             switch (tempVar8)
2456             {
2457                 case 0: // command none - process
2458                     tempVar8 |= 0x80;
2459                     statusOp_write(&(pAstCfg->xDec[z].decodeStatus.command2),
2460                                    &tempVar8,
2461                                    sizeof(tempVar8),
2462                                    GATEMP_INDEX_DEC);
2463                     break;
2464                 case 1: // command abort - leave now
2465                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command abort (0x%02x)", as+zS, 1);
2466                     tempVar8 |= 0x80;
2467                     statusOp_write(&(pAstCfg->xDec[z].decodeStatus.command2),
2468                                    &tempVar8,
2469                                    sizeof(tempVar8),
2470                                    GATEMP_INDEX_DEC);
2471                     return (ASPERR_ABORT);
2472                 case 2: // command restart - leave later
2473                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command quit (0x%02x)", as+zS, 2);
2474                     tempVar8 |= 0x80;
2475                     statusOp_write(&(pAstCfg->xDec[z].decodeStatus.command2),
2476                                    &tempVar8,
2477                                    sizeof(tempVar8),
2478                                    GATEMP_INDEX_DEC);
2479                     return (ASPERR_QUIT);
2480                 default: // command unknown - ignore
2481                     break;
2482             }
2483         }
2484 #else
2485         if (!(pAstCfg->xDec[z].decodeStatus.command2 & 0x80))
2486         {
2487             switch (pAstCfg->xDec[z].decodeStatus.command2)
2488             {
2489                 case 0: // command none - process
2490                     pAstCfg->xDec[z].decodeStatus.command2 |= 0x80;
2491                     break;
2492                 case 1: // command abort - leave now
2493                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command abort (0x%02x)", as+zS, 1);
2494                     pAstCfg->xDec[z].decodeStatus.command2 |= 0x80;
2495                     return (ASPERR_ABORT);
2496                 case 2: // command restart - leave later
2497                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command quit (0x%02x)", as+zS, 2);
2498                     pAstCfg->xDec[z].decodeStatus.command2 |= 0x80;
2499                     return (ASPERR_QUIT);
2500                 default: // command unknown - ignore
2501                     break;
2502             }
2503         }
2504 #endif
2505     }
2507     return 0;
2508 } //PAF_ASIT_decodeCommand
2510 // -----------------------------------------------------------------------------
2511 // ASIT Decoding Function - Reinitialization of Decode
2512 //
2513 //   Name:      PAF_ASIT_decodeInit
2514 //   Purpose:   Decoding Function for reinitializing the decoding process.
2515 //   From:      AST Parameter Function -> decodeProcessing
2516 //   Uses:      See code.
2517 //   States:    x
2518 //   Return:    Error number in standard or SIO form (0 on success).
2519 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2520 //              * State information as per parent.
2521 //
2522 Int
2523 PAF_ASIT_decodeInit(
2524     const PAF_ASIT_Params *pP, 
2525     const PAF_ASIT_Patchs *pQ, 
2526     PAF_ASIT_Config *pAsitCfg, 
2527     Int sourceSelect
2530     PAF_AST_Config *pAstCfg;
2531     PAF_AST_DecOpCircBufCtl *pCbCtl;    /* Decoder output circular buffer control */
2532     Int as;                             /* Audio Stream Number (1, 2, etc.) */
2533     Int z;                              /* decode/encode counter */
2534     Int errno;                          /* error number */
2535     Int zI, zS;
2536     Int zMD;
2537     Int zMI;
2538     ASP_Msg* pAspMsg;                   /* Messaging */
2539     Int argIdx;
2540     Int status;
2541 #ifdef NON_CACHE_STATUS
2542     Int8 tempVar8;
2543 #endif
2544     
2545     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
2546     as = pAstCfg->as;
2547     zMD = pAstCfg->masterDec;
2548     zMI = pP->zone.master;
2549     (void)as;  // clear compiler warning in case not used with tracing disabled
2550     
2551     pCbCtl = &pAsitCfg->pAspmCfg->decOpCircBufCtl; // get pointer to circular buffer control
2553 #ifdef NON_CACHE_STATUS
2554     // reset frameCount
2555     for (z=DECODE1; z < DECODEN; z++)
2556     {
2557         statusOp_read(&tempVar8,
2558                       &(pAstCfg->xDec[z].decodeStatus.mode),
2559                       sizeof(tempVar8),
2560                       GATEMP_INDEX_DEC);
2561         if (tempVar8)
2562         {
2563             tempVar8 = 0;
2564             statusOp_write(&(pAstCfg->xDec[z].decodeStatus.frameCount),
2565                           &tempVar8,
2566                           sizeof(tempVar8),
2567                           GATEMP_INDEX_DEC);
2568         }
2569     }
2571     for (z=DECODE1; z < DECODEN; z++) 
2572     {
2573         zI = pP->inputsFromDecodes[z];
2574         zS = pP->streamsFromDecodes[z];
2575         (void)zS; // clear compiler warning in case not used with tracing disabled
2576         statusOp_read(&tempVar8,
2577                       &(pAstCfg->xDec[z].decodeStatus.mode),
2578                       sizeof(tempVar8),
2579                       GATEMP_INDEX_DEC);
2580         if (pAstCfg->xInp[zI].hRxSio && tempVar8)
2581         {
2582 #else
2583     // reset frameCount
2584     for (z=DECODE1; z < DECODEN; z++)
2585     {
2586         if (pAstCfg->xDec[z].decodeStatus.mode)
2587         {
2588             pAstCfg->xDec[z].decodeStatus.frameCount = 0;
2589         }
2590     }
2592     for (z=DECODE1; z < DECODEN; z++)
2593     {
2594         zI = pP->inputsFromDecodes[z];
2595         zS = pP->streamsFromDecodes[z];
2596         (void)zS; // clear compiler warning in case not used with tracing disabled
2597         if (pAstCfg->xInp[zI].hRxSio && pAstCfg->xDec[z].decodeStatus.mode)
2598         {
2599 #endif
2600             Uns gear;
2601             Int frameLength;
2602             TRACE_VERBOSE1("AS%d: PAF_ASIT_decodeInit: initializing decode", as+zS);
2604             // write back Dec configuration
2605             Cache_wb(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2606             Cache_wait();
2608             // FL: send dec activate message to slave
2609             pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize);  /* allocate message */
2610             if (pAspMsg == NULL)
2611             {
2612                 TRACE_TERSE0("MessageQ_alloc() failure.");
2613                 SW_BREAKPOINT; // temporary
2614                 return -1; // temporary
2615             }
2616             MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
2617             pAspMsg->cmd = ASP_SLAVE_DEC_ACTIVATE;                                              /* fill in message payload */
2618             pAspMsg->procId = hAspMsgMaster->masterProcId;
2619             pAspMsg->expectResp = TRUE;
2620             pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
2621             argIdx = 0; // set decIdx (zone index)
2622             *(Int32 *)&pAspMsg->buf[argIdx] = z;
2623             TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2624             TRACE_MSG1("decIdx=%d", pAspMsg->buf[0]);
2625             status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);                       /* send message */
2626             if (status != MessageQ_S_SUCCESS)
2627             {
2628                 SW_BREAKPOINT;
2629             }
2630             // wait for dec activate complete message from slave
2631             status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
2632             if (status != MessageQ_S_SUCCESS)
2633             {
2634                 TRACE_TERSE0("MessageQ_get() failure.");
2635                 SW_BREAKPOINT; // temporary
2636                 return -1; // temporary
2637             }
2638             if ((pAspMsg->procId != hAspMsgMaster->slaveProcId) || 
2639                 (pAspMsg->cmd != ASP_MASTER_DEC_ACTIVATE_DONE) ||
2640                 (pAspMsg->messageId != (hAspMsgMaster->messageId | ((UInt32)1<<31))))
2641             {
2642                 TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2643                 SW_BREAKPOINT; // temporary
2644                 return -1; // temporary
2645             }      
2646             hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
2647             TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2648             // free the message
2649             status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
2650             if (status != MessageQ_S_SUCCESS)
2651             {
2652                 SW_BREAKPOINT;
2653             }
2654             
2655 #if 0 // FL: decoder activate call, slave
2656             if (decAlg[z]->fxns->algActivate)
2657                 decAlg[z]->fxns->algActivate (decAlg[z]);
2658 #endif
2660             // FL: send dec reset message to slave
2661             pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize);  /* allocate message */
2662             if (pAspMsg == NULL)
2663             {
2664                 TRACE_TERSE0("MessageQ_alloc() failure.");
2665                 SW_BREAKPOINT; // temporary
2666                 return -1; // temporary
2667             }
2668             MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
2669             pAspMsg->cmd = ASP_SLAVE_DEC_RESET;                                                 /* fill in message payload */
2670             pAspMsg->procId = hAspMsgMaster->masterProcId;
2671             pAspMsg->expectResp = TRUE;
2672             pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
2673             argIdx = 0; // set decIdx
2674             *(Int32 *)&pAspMsg->buf[argIdx] = z;
2675             TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2676             TRACE_MSG1("decIdx=%d", pAspMsg->buf[0]);
2677             // wait for dec reset complete message from slave
2678             status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message */
2679             if (status != MessageQ_S_SUCCESS)
2680             {
2681                 SW_BREAKPOINT;
2682             }
2683             status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
2684             if (status != MessageQ_S_SUCCESS)
2685             {
2686                 TRACE_TERSE0("MessageQ_get() failure.");
2687                 SW_BREAKPOINT; // temporary
2688                 return -1; // temporary
2689             }
2690             if ((pAspMsg->procId == hAspMsgMaster->slaveProcId) &&
2691                 (pAspMsg->cmd == ASP_MASTER_DEC_RESET_DONE) && 
2692                 (pAspMsg->messageId == (hAspMsgMaster->messageId | ((UInt32)1<<31))))
2693             {
2694                 hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
2695                 TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2696                 TRACE_MSG1("decErrno=%d", pAspMsg->buf[0]);
2698                 argIdx = 0; // get decErrno
2699                 errno = *(Int32 *)&pAspMsg->buf[argIdx];
2700             }
2701             else
2702             {
2703                 //
2704                 // Invalid message received
2705                 //
2706                 TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2707                 SW_BREAKPOINT; // temporary
2708                 return -1; // temporary
2709             }
2710             // free the message
2711             status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
2712             if (status != MessageQ_S_SUCCESS)
2713             {
2714                 SW_BREAKPOINT;
2715             }
2716             
2717             // (***) FL: revisit
2718             // invalidate Dec configuration
2719             Cache_inv(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2720             Cache_wait();
2721             
2722 #if 0 // FL: decoder reset call, slave
2723             if (dec->fxns->reset
2724                 && (errno = dec->fxns->reset (dec, NULL,
2725                                               &pC->xDec[z].decodeControl, &pC->xDec[z].decodeStatus)))
2726                 return errno;
2727 #endif
2728             if (errno != 0)
2729             {
2730                 return errno;
2731             }
2732             
2733 #ifdef NON_CACHE_STATUS
2734             gear = 0;  // due to size difference
2735             statusOp_read(&gear,
2736                           &(pAstCfg->xDec[z].decodeStatus.aspGearControl),
2737                           sizeof(Int8),
2738                           GATEMP_INDEX_DEC);
2739             tempVar8 = gear < GEARS ? gear : 0;
2740             statusOp_write(&(pAstCfg->xDec[z].decodeStatus.aspGearStatus),
2741                            &tempVar8,
2742                            sizeof(tempVar8),
2743                            GATEMP_INDEX_DEC);
2744 #else
2745             gear = pAstCfg->xDec[z].decodeStatus.aspGearControl;
2746             pAstCfg->xDec[z].decodeStatus.aspGearStatus = gear < GEARS ? gear : 0;
2747 #endif
2748             
2749 #if 0 // FL: change handle to decIdx (zone index)
2750             frameLength = pP->fxns->computeFrameLength(decAlg[z], 
2751                 FRAMELENGTH,
2752                 pC->xDec[z].decodeStatus.bufferRatio);
2753 #endif
2754 #if 0 // (***) FL: revisit. Bypass computeFrameLength().
2755             frameLength = pP->fxns->computeFrameLength(z, 
2756                 FRAMELENGTH, 
2757                 pC->xDec[z].decodeStatus.bufferRatio);
2758 #else
2759             if (sourceSelect == PAF_SOURCE_PCM)
2760             {
2761                 frameLength = PAF_SYS_FRAMELENGTH;
2762             }
2763             else if ((sourceSelect == PAF_SOURCE_DDP) || (sourceSelect == PAF_SOURCE_AC3))
2764             {
2765                 frameLength = 1536;
2766             }
2767             else if (sourceSelect == PAF_SOURCE_THD)
2768             {
2769                 frameLength = 1536; //QIN FIX ME
2770             }
2771             else
2772             {
2773                 frameLength = 256;
2774             }
2775 #endif    
2776             
2777             pAstCfg->xDec[z].decodeControl.frameLength = frameLength;
2778             pAstCfg->xDec[z].decodeInStruct.sampleCount = frameLength;
2779             pAstCfg->xDec[z].decodeControl.sampleRate = PAF_SAMPLERATE_UNKNOWN;
2780             
2781             // Initialize decoder output circular buffer for selected source
2782             errno = cbInitSourceSel(pCbCtl, z, sourceSelect, frameLength, FRAMELENGTH, 0);
2783             if (errno)
2784             {
2785                 SW_BREAKPOINT; // FL: debug
2786                 return errno;
2787             }
2788             // FL: debug
2789             cbLog(pCbCtl, z, 1, "PAF_ASIT_decodeInit:cbInitSourceSel");
2790             
2791             if (z != zMD) 
2792             {
2793                 if (errno = SIO_idle(pAstCfg->xInp[zI].hRxSio))
2794                 {
2795                     return errno;
2796                 }
2797             }
2799 #ifdef NON_CACHE_STATUS
2800             statusOp_read(&tempVar8,
2801                           &(pAstCfg->xDec[z].decodeStatus.sourceSelect),
2802                           sizeof(Int8),
2803                           GATEMP_INDEX_DEC);
2804             if (errno = SIO_ctrl(pAstCfg->xInp[zI].hRxSio, PAF_SIO_CONTROL_SET_SOURCESELECT,
2805                 DECSIOMAP(tempVar8)))
2806             {
2807                 return errno;
2808             }
2809 #else
2810             if (errno = SIO_ctrl(pAstCfg->xInp[zI].hRxSio, PAF_SIO_CONTROL_SET_SOURCESELECT,
2811                 DECSIOMAP(pAstCfg->xDec[z].decodeStatus.sourceSelect)))
2812             {
2813                 return errno;
2814             }
2815 #endif
2816             if (errno = SIO_ctrl(pAstCfg->xInp[zI].hRxSio, PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, 
2817                 frameLength))
2818             {
2819                 return errno;
2820             }
2821             if (errno = pP->fxns->updateInputStatus(pAstCfg->xInp[zI].hRxSio, &pAstCfg->xInp[zI].inpBufStatus, 
2822                 &pAstCfg->xInp[zI].inpBufConfig))
2823             {
2824                 return errno;
2825             }
2826         }
2827     }
2829     if (pAstCfg->xInp[zMI].hRxSio) 
2830     {
2831         errno = SIO_issue(pAstCfg->xInp[zMI].hRxSio, &pAstCfg->xInp[zMI].inpBufConfig,
2832             sizeof(pAstCfg->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME);
2833         if (errno)
2834         {
2835             return errno;
2836         }
2837     }
2839     return 0;
2840 } //PAF_AST_decodeInit
2842 // -----------------------------------------------------------------------------
2843 // ASIT Decoding Function - Info Processing, Common
2844 //
2845 //   Name:      PAF_ASIT_decodeInfo
2846 //   Purpose:   Decoding Function for processing information in a manner that
2847 //              is common for both initial and subsequent frames of input data.
2848 //   From:      AST Parameter Function -> decodeProcessing
2849 //   Uses:      See code.
2850 //   States:    x
2851 //   Return:    Error number in standard form (0 on success).
2852 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2853 //              * State information as per parent.
2854 //
2855 Int
2856 PAF_ASIT_decodeInfo(
2857     const PAF_ASIT_Params *pP, 
2858     const PAF_ASIT_Patchs *pQ, 
2859     PAF_ASIT_Config *pAsitCfg, 
2860     Int frame, 
2861     Int block
2864     PAF_AST_Config *pAstCfg;
2865     Int as;                    /* Audio Stream Number (1, 2, etc.) */
2866     Int z;                     /* input/decode/stream counter */
2867     Int errno;                 /* error number */
2868     Int sioErr;                /* error number, SIO */
2869     Int zD, zI, zS, zX;
2870     Int zMD;
2871     Int zMI;
2872     Int zMS;
2873     UInt32 curTime;
2874     ASP_Msg *pAspMsg;          /* Messaging */
2875     Int argIdx;
2876     Int status;
2877 #ifdef NON_CACHE_STATUS
2878     Int8 tempVar8;
2879     Int tempVar;
2880 #endif
2881     // FL: revisit
2882     //Int size;
2883     //PAF_InpBufConfig *pIpBufConfig;
2885     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
2886     as = pAstCfg->as;
2887     zMD = pAstCfg->masterDec;
2888     zMS = pAstCfg->masterStr;
2889     zMI = pP->zone.master;
2890     (void)zMS;  (void)as;  // clear compiler warning in case not used with tracing disabled
2891     
2892     // Set decode control: sample rate, emphasis
2893     for (z=INPUT1; z < INPUTN; z++)
2894     {
2895         zD = z;
2896         for (zX = DECODE1; zX < DECODEN; zX++) 
2897         {
2898             if (pP->inputsFromDecodes[zX] == z) 
2899             {
2900                 zD = zX;
2901                 break;
2902             }
2903         }
2904 #ifdef PROFILER
2905             // modify for different sampling rate
2906             if (pAstCfg->xInp[z].inpBufStatus.sampleRateStatus == PAF_SAMPLERATE_96000HZ)