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