Add GateMP for Decoder Output Circular Buffer
[processor-sdk/performance-audio-sr.git] / processor_audio_sdk_1_00_00_00 / pasdk / test_dsp / framework / audioStreamInpProc.c
2 /*
3 Copyright (c) 2016, Texas Instruments Incorporated - http://www.ti.com/
4 All rights reserved.
6 * Redistribution and use in source and binary forms, with or without 
7 * modification, are permitted provided that the following conditions
8 * are met:
9 *
10 * Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 *
13 * Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the
16 * distribution.
17 *
18 * Neither the name of Texas Instruments Incorporated nor the names of
19 * its contributors may be used to endorse or promote products derived
20 * from this software without specific prior written permission.
21 *
22 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
23 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
24 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
25 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
26 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
27 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
28 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
29 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
30 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
31 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
32 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33 *
34 */
36 /*
37  *  ======== audioStreamInpProc.c ========
38  */
40 #include <xdc/std.h>
41 #include <xdc/cfg/global.h>
42 #include <xdc/runtime/Diags.h>
43 #include <xdc/runtime/Error.h>
44 #include <xdc/runtime/Log.h>
45 #include <xdc/runtime/Memory.h>
46 #include <xdc/runtime/System.h>
47 #include <ti/sysbios/BIOS.h>
48 #include <ti/sysbios/hal/Hwi.h>
49 #include <ti/sysbios/hal/Cache.h>
50 #include <ti/sysbios/knl/Clock.h>
51 #include <ti/sysbios/knl/Task.h>
52 #include <ti/ipc/Ipc.h>
53 #include <ti/ipc/MessageQ.h>
54 #include <ti/ipc/MultiProc.h>
56 #include <sio.h>
57 #include <pafsio_ialg.h>
59 #include "common.h"
60 #include "paf_heapMgr.h"
61 #include "aspMsg_common.h"
62 #include "aspMsg_master.h"
63 #include "aspDecOpCircBuf_master.h"
64 #include "audioStreamProc_common.h"
65 #include "audioStreamProc_master.h"
66 #include "audioStreamInpProc.h"
68 // FL: porting
69 #include "fwkSim.h"
70 //#include "fwkPort.h"
71 // FL: debug
72 #include "dbgCapAf.h"
75 // -----------------------------------------------------------------------------
76 // Debugging Trace Control, local to this file.
77 // 
78 #include "logp.h"
80 #define TRACE_ARC(a)
82 // allows you to set a different trace module in pa.cfg
83 #define TR_MOD  trace
85 // Allow a developer to selectively enable tracing.
86 #define CURRENT_TRACE_MASK      0x21
88 #define TRACE_MASK_TERSE        0x01   // only flag errors and show init
89 #define TRACE_MASK_GENERAL      0x02   // half dozen lines per frame
90 #define TRACE_MASK_VERBOSE      0x04   // trace full operation
91 #define TRACE_MASK_DATA         0x08   // Show data
92 #define TRACE_MASK_TIME         0x10   // Timing related traces
93 #define TRACE_MASK_MSG          0x20   // Message related traces
95 #if !(CURRENT_TRACE_MASK & TRACE_MASK_TERSE)
96     #undef  TRACE_TERSE0
97     #undef  TRACE_TERSE1
98     #undef  TRACE_TERSE2
99     #undef  TRACE_TERSE3
100     #undef  TRACE_TERSE4
101     #define TRACE_TERSE0(a)
102     #define TRACE_TERSE1(a,b)
103     #define TRACE_TERSE2(a,b,c)
104     #define TRACE_TERSE3(a,b,c,d)
105     #define TRACE_TERSE4(a,b,c,d,e)
106 #endif
108 #if !(CURRENT_TRACE_MASK & TRACE_MASK_GENERAL)
109     #undef  TRACE_GEN0
110     #undef  TRACE_GEN1
111     #undef  TRACE_GEN2
112     #undef  TRACE_GEN3
113     #undef  TRACE_GEN4
114     #define TRACE_GEN0(a)
115     #define TRACE_GEN1(a,b)
116     #define TRACE_GEN2(a,b,c)
117     #define TRACE_GEN3(a,b,c,d)
118     #define TRACE_GEN4(a,b,c,d,e)
119 #endif
121 #if (CURRENT_TRACE_MASK & TRACE_MASK_VERBOSE)
122     // consolidate list of processing strings, indexed by PAF_SOURCE
123     static char *procName[] =
124     {
125         "", //PAF_SOURCE_UNKNOWN
126         "", //PAF_SOURCE_NONE
127         "AS%d: Pass processing ...",   //PAF_SOURCE_PASS
128         "AS%d: SNG processing ...",    //PAF_SOURCE_SNG
129         "AS%d: Auto processing ...",   //PAF_SOURCE_AUTO
130         "AS%d: Auto processing ...",   //PAF_SOURCE_BITSTREAM
131         "AS%d: DTS processing ...",    //PAF_SOURCE_DTSALL
132         "AS%d: PCM processing ...",    //PAF_SOURCE_PCMAUTO
133         "AS%d: PCM processing ...",    //PAF_SOURCE_PCM
134         "AS%d: PCN processing ...",    //PAF_SOURCE_PC8
135         "AS%d: AC3 processing ...",    //PAF_SOURCE_AC3
136         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS
137         "AS%d: AAC processing ...",    //PAF_SOURCE_AAC
138         "AS%d: MPG processing ...",    //PAF_SOURCE_MPEG
139         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS12
140         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS13
141         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS14
142         "AS%d: DTS processing ...",    //PAF_SOURCE_DTS16
143         "AS%d: WMP processing ...",    //PAF_SOURCE_WMA9PRO
144         "AS%d: MP3 processing ...",    //PAF_SOURCE_MP3
145         "AS%d: DSD processing ...",    //PAF_SOURCE_DSD1
146         "AS%d: DSD processing ...",    //PAF_SOURCE_DSD2
147         "AS%d: DSD processing ...",    //PAF_SOURCE_DSD3
148         "AS%d: DDP processing ...",    //PAF_SOURCE_DDP
149         "AS%d: DTSHD processing ...",  //PAF_SOURCE_DTSHD
150         "AS%d: THD processing ...",    //PAF_SOURCE_THD
151         "AS%d: DXP processing ...",    //PAF_SOURCE_DXP
152         "AS%d: WMA processing ...",    //PAF_SOURCE_WMA
153     };
155 #else
156     #undef  TRACE_VERBOSE0
157     #undef  TRACE_VERBOSE1
158     #undef  TRACE_VERBOSE2
159     #undef  TRACE_VERBOSE3
160     #undef  TRACE_VERBOSE4
161     #define TRACE_VERBOSE0(a)
162     #define TRACE_VERBOSE1(a,b)
163     #define TRACE_VERBOSE2(a,b,c)
164     #define TRACE_VERBOSE3(a,b,c,d)
165     #define TRACE_VERBOSE4(a,b,c,d,e)
166 #endif
168 #if (CURRENT_TRACE_MASK & TRACE_MASK_DATA)
169     #define TRACE_DATA(a) LOG_printf a
170 #else
171     #define TRACE_DATA(a)
172 #endif
174 #if (CURRENT_TRACE_MASK & TRACE_MASK_TIME)
175     #define TRACE_TIME(a) LOG_printf a
176     #define TIME_MOD  trace // this could be different
177     static Int dtime()
178     {
179          static Int old_time = 0;
180          Int time = TSK_time();
181          Int delta_time = time - old_time;
182          old_time = time;
183          return( delta_time);
184     }
186     static char *stateName[11] =
187     {
188          "INIT",
189          "INFO1",
190          "AGAIN",
191          "INFO2",
192          "CONT",
193          "TIME",
194          "DECODE",
195          "STREAM",
196          "ENCODE",
197          "FINAL",
198          "QUIT"
199     };
201 #else
202     #define TRACE_TIME(a)
203 #endif
205 #if !(CURRENT_TRACE_MASK & TRACE_MASK_MSG)
206     #undef  TRACE_MSG0
207     #undef  TRACE_MSG1
208     #undef  TRACE_MSG2
209     #undef  TRACE_MSG3
210     #undef  TRACE_MSG4
211     #define TRACE_MSG0(a)
212     #define TRACE_MSG1(a,b)
213     #define TRACE_MSG2(a,b,c)
214     #define TRACE_MSG3(a,b,c,d)
215     #define TRACE_MSG4(a,b,c,d,e)
216 #endif
217     
219 // .............................................................................
221 #include <pafsio.h>
222 #include "paferr.h"
224 #include <acp_mds.h>
226 #include <pcm.h>
228 #include <pce.h>
230 #include <doberr.h>
232 #include <diberr.h>
234 #include <stdasp.h>
236 #include "as0.h"
237 #include "asperr.h"
239 #include "audioStreamProc_params.h"
240 #include "audioStreamProc_patchs.h"
241 #include "audioStreamProc_config.h"
242 #include "audioStreamInpProc.h"
244 //
245 // Audio Stream Definitions
246 //
248 // minimum audio frame "length" in samples (must be multiple of PA_MODULO)
249 #define MINFRAMELENGTH 24
250 #define PA_MODULO       8   // also defined independently in ARC2 code, and may be hard coded other places.
253 //
254 // Decoder Definitions
255 //
256 //#define decLinkInit pQ->i_decLinkInit
258 //
259 // Audio Stream Processing Definitions
260 //
261 //#define aspLinkInit pQ->i_aspLinkInit
263 //
264 // Encoder Definitions
265 //
266 #define encLinkInit pQ->i_encLinkInit
268 //
269 // Input, Output Definitions
270 //
271 #define inpLinkInit pP->i_inpLinkInit
272 //#define outLinkInit pP->i_outLinkInit
274 /* ---------------------------------------------------------------- */
275 /*              Parameter macro definitions end here.               */
276 /* ---------------------------------------------------------------- */
278 //
279 // Standardized Definitions
280 //
282 //#define DEC_Handle PCM_Handle /* works for all: SNG, PCM, AC3, DTS, AAC */
283 //#define ENC_Handle PCE_Handle /* works for all: PCE */
285 #define __TASK_NAME__  "TaskAsip"
287 LINNO_DEFN(TaskAsip); /* Line number macros */
288 ERRNO_DEFN(TaskAsip); /* Error number macros */
290 // ASIT configuration
291 #pragma DATA_SECTION(gPAF_ASIT_config, ".globalSectionPafAsitConfig")
292 PAF_ASIT_Config gPAF_ASIT_config = {
293     NULL,               // acp
294     &gPAF_ASPM_config,  // pAspmCfg, shared ASIT/ASOT configuration
295     &gPAF_AST_config    // pAstCfg, shared ASIT/ASOT/ASDT configuration
296 };
298 // Global debug counters */
299 UInt32 gTaskAsipCnt=0; // debug
300 UInt32 gAsipInitCnt     =0;
301 UInt32 gAsipInfo1Cnt    =0;
302 UInt32 gAsipInfo2Cnt    =0;
303 UInt32 gAsipDecodeCnt   =0;
304 UInt32 gAsipFinalCnt    =0;
305 UInt32 gAsipQuitCnt     =0;
306 #include "dbgDib.h"
308 extern struct {
309     Int size;
310     IALG_Status *pStatus[512];
311 } IACP_STD_BETA_TABLE;
314 /*
315  *  ======== taskAsipFxn ========
316  *  Audio Stream Input Processing task function
317  */
318 Void taskAsipFxn(
319 //    Int betaPrimeValue, // FL: revisit
320     const PAF_ASIT_Params *pP,
321     const PAF_ASIT_Patchs *pQ
324     PAF_ASIT_Config *pC;            /* Local configuration pointer */
325     PAF_AST_Config *pAstCfg;        /* Common (shared) configuration pointer */
326     Int as;                         /* Audio Stream Number (1, 2, etc.) */
327     Int z;                          /* input/encode/stream/decode/output counter */
328     Int i;                          /* phase */
329     Int errno;                      /* error number */
330     Int zMD, zMI, zMS, zX;
331     Int loopCount = 0;  // used to stop trace to see startup behavior.        
332     UInt32 curTime;
333     Int size;
334     // Messaging
335     ASP_Msg *pAspMsg;              
336     Int status;
338     Log_info0("Enter taskAsipFxn()");
339     
340 #ifdef SIMULATE_SIO
341     /* Start simulation */
342     simStart();
343 #endif // SIMULATE_SIO
345     //
346     // Audio Framework Parameters & Patch (*pP, *pQ)
347     //
348     if (!pP) 
349     {
350         TRACE_TERSE0("TaskAsip: No Parameters defined. Exiting.");
351         LINNO_RPRT(TaskAsip, -1);
352         return;
353     }
355     if (!pQ)
356     {
357         TRACE_TERSE0("TaskAsip: No Patchs defined. Exiting.");
358         LINNO_RPRT(TaskAsip, -1);
359         return;
360     }    
361     
362     //
363     // Audio Framework Configuration (*pC):
364     //
365     pC = &gPAF_ASIT_config;
366     pAstCfg = pC->pAstCfg;
368     /* Set Audio Stream Number (1, 2, etc.) */
369     as = gBetaPrimeValue + 1;
370     pAstCfg->as = as;    
371     TRACE_TERSE1("TaskAsip: Started with AS%d.", as);
373     //
374     // Initialize message log trace and line number reporting
375     //
376     for (z=STREAM1; z < STREAMN; z++)
377     {
378         TRACE_TERSE1("TaskAsip: AS%d: initiated", as+z);
379     }
380     LINNO_RPRT(TaskAsip, -1);
381     
382     //
383     // Determine decoder and stream indices associated with the master input
384     //
385     zMI = pP->zone.master;
386     pAstCfg->masterDec = zMI;
387     pAstCfg->masterStr = zMI;
388     for (zX = DECODE1; zX < DECODEN; zX++)
389     {
390         if (pP->inputsFromDecodes[zX] == zMI)
391         {
392             pAstCfg->masterDec = zX;
393             pAstCfg->masterStr = pP->streamsFromDecodes[zX];
394             break;
395         }
396     }
397     zMD = pAstCfg->masterDec;
398     zMS = pAstCfg->masterStr;
400     // Initialize as per parametrized phases:
401     //
402     //   In standard form these are:
403     //      - Malloc: Memory Allocation
404     //      - Config: Configuration Initialization
405     //      - AcpAlg: ACP Algorithm Initialization and Local Attachment
406     //      - Common: Common Memory Initialization
407     //      - AlgKey: Dec/Enc chain to Array Initialization
408     //      - Device: I/O Device Initialization
409     //      - DecOpCircBuf: Decoder Output Circular Buffer
410     //      - Unused: (available)
411     //
412     LINNO_RPRT(TaskAsip, -2);
413     for (i=0; i < lengthof(pP->fxns->initPhase); i++)
414     {
415         Int linno;
416         if (pP->fxns->initPhase[i])
417         {
418             if (linno = pP->fxns->initPhase[i](pP, pQ, pC)) 
419             {
420                 LINNO_RPRT(TaskAsip, linno);
421                 return;
422             }
423         }
424         else 
425         {
426             TRACE_TERSE1("TaskAsip: AS%d: initialization phase - null", as+zMS);
427         }
428         TRACE_TERSE2("TaskAsip: AS%d: initialization phase - %d completed", as+zMS, i);
429         LINNO_RPRT(TaskAsip, -i-3);
430     }
432     //
433     // End of Initialization -- display memory usage report.
434     //
435     if (pP->fxns->memStatusPrint)
436     {
437         pP->fxns->memStatusPrint(HEAP_INTERNAL, HEAP_INTERNAL1, HEAP_EXTERNAL, HEAP_INTERNAL1_SHM);
438     }
439     
440     // (***) FL: revisit
441     // write back configuration
442     Cache_wb(pAstCfg, sizeof(PAF_AST_Config), Cache_Type_ALLD, 0);
443     // FL: no need to share this pointer, can be local
444     //Cache_wb(&pC, sizeof(PAF_AST_Config *), Cache_Type_ALLD, 0);
445     Cache_wait();
447     // (***) FL: revisit
448     // write Dec configuration
449     Cache_wb(&pAstCfg->xDec[0], DECODEN*sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
450     Cache_wait();
452     // (***) FL: revisit
453     // write back entire beta table
454     Cache_wb((Ptr)(&IACP_STD_BETA_TABLE.pStatus[0]), 512*sizeof(IALG_Status *), Cache_Type_ALLD, 0);
455     Cache_wait();
456     
457     // FL: send start initialization message to slave
458     pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize); /* allocate message */
459     MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
460     pAspMsg->cmd = ASP_SLAVE_START;                                                     /* fill in message payload */
461     pAspMsg->procId = hAspMsgMaster->masterProcId;
462     pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
463     pAspMsg->expectResp = TRUE;
464     TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
465     status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message */
466     if (status != MessageQ_S_SUCCESS)
467     {
468         SW_BREAKPOINT;
469     }
470     // wait for initialization complete message from slave
471     do {
472         //status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
473         status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, 0); // FL: no other thread is allowed to run until Slave finished startup
474     } while ((status != MessageQ_S_SUCCESS) || (pAspMsg->cmd != ASP_MASTER_START_DONE));
475     if ((pAspMsg->procId != hAspMsgMaster->slaveProcId) ||
476         (pAspMsg->cmd != ASP_MASTER_START_DONE) || 
477         (pAspMsg->messageId != (hAspMsgMaster->messageId | ((UInt32)1<<31))))
478     {
479         TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
480         SW_BREAKPOINT;
481     }
482     hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
483     TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
484     status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
485     if (status != MessageQ_S_SUCCESS)
486     {
487         SW_BREAKPOINT;
488     }
490     // (***) FL: revisit
491     // invalidate Status structure addresses for Beta Units initialized on Slave
492     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
493     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
494     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
495     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
496     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
497     Cache_wait();
498     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]) Log_info0("ERROR: beta unit for Dec==NULL");
499     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]) Log_info0("ERROR: beta unit for Dec==NULL");
500     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]) Log_info0("ERROR: beta unit for Dec==NULL");
501     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]) Log_info0("ERROR: beta unit for Dec==NULL");
502     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]) Log_info0("ERROR: beta unit for Dec==NULL");
503     
504     // (***) FL: revisit
505     // invalidate Status structures for Beta Units initialized on Slave
506     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), sizeof(Int), Cache_Type_ALLD, 0);
507     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]->size;
508     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), size, Cache_Type_ALLD, 0);
509     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), sizeof(Int), Cache_Type_ALLD, 0);
510     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]->size;
511     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), size, Cache_Type_ALLD, 0);
512     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]), sizeof(Int), Cache_Type_ALLD, 0);
513     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]->size;
514     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]), size, Cache_Type_ALLD, 0);
515     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), sizeof(Int), Cache_Type_ALLD, 0);
516     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]->size;
517     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), size, Cache_Type_ALLD, 0);
518     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]), sizeof(Int), Cache_Type_ALLD, 0);
519     size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]->size;
520     Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]), size, Cache_Type_ALLD, 0);
521     Cache_wait();
522     
523     // (***) FL: revisit
524     // invalidate Dec configuration
525     Cache_inv(&gPAF_AST_config.xDec[0], DECODEN*sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
526     Cache_wait();
527     
528     //
529     // Main processing loop
530     //   
531     for (z=STREAM1; z < STREAMN; z++)
532     {
533         TRACE_VERBOSE1("TaskAsip: AS%d: running", as+z);
534     }
536     TRACE_TERSE0("TaskAsip: Entering Main Loop.");
537     
538     errno = 0;
539     for (;;)
540     {
541         Int sourceSelect;
542         XDAS_Int8 sourceProgram;
544         loopCount++;
546 #if 0   // enable and tune to see startup behavior.
547         // this is an alternative to fixed/circular setting in pa.cfg.
548         // If you are searching for a memory allocation failure, disable on first round.
549         // All allocation has already happened.
550         // This is the outer loop.  This loop count goes up when the stream resets.
551         // If the stream is running without problems, this does not increment.
552         // If the stream is repeatedly resetting, this loop count will go up rapidly.
553         if (loopCount > 10)  // see traces for a few of the passes through the main loop.
554         {
555              TRACE_TERSE1("TaskAsip: Trace stopped at loop %d.", loopCount);
556              LOG_disable(&TR_MOD);  // stop tracing
557         }
558 #endif
560         TRACE_GEN2("TaskAsip (begin Main loop %d) (errno 0x%x)", loopCount, errno);
561         TRACE_TIME((&TIME_MOD, "as1_f2... + %d = %d (begin Main loop)", dtime(), TSK_time()));
562         
563         // since not decoding indicate such
564         pP->fxns->sourceDecode(pP, pQ, pC, PAF_SOURCE_NONE);
566         // any error forces idling of input
567         if (errno) 
568         {
569             for (z=INPUT1; z < INPUTN; z++)
570             {
571                 if (pAstCfg->xInp[z].hRxSio)
572                 {
573                     SIO_idle(pAstCfg->xInp[z].hRxSio);
574                 }
575             }
576         
577             TRACE_TERSE1("TaskAsip: Trace stopped at loop %d.", loopCount);
578             ERRNO_RPRT(TaskAsip, errno);
579         }
580         
581         // Execute a TSK_sleep to ensure that any non-blocking code paths are broken
582         // up to allow lower priority tasks to run. This may seem odd to be at the top
583         // of the state machine but provides for a cleaner flow even though the very
584         // first time we enter we do a sleep which is non-intuitive.
585         TRACE_VERBOSE1("TaskAsip: AS%d: ... sleeping ...", as+zMS);
586         TRACE_TIME((&TIME_MOD, "as1-f2... + %d = %d (begin SLEEP)", dtime(), TSK_time()));
587         Task_sleep(1);
589         TRACE_GEN1("TaskAsip: AS%d: Input device selection ...", as+zMS);
590         if (errno = pP->fxns->selectDevices(pP, pQ, pC))
591         {
592             TRACE_TERSE2("TaskAsip: selectDevices returned errno = 0x%04x at line %d. AS%d", errno, as+zMS);
593             continue;
594         }
596         // if no master input selected then we don't know what may be at the input
597         // so set to unknown and skip any remaining processing
598         if (!pAstCfg->xInp[zMI].hRxSio)
599         {
600             pAstCfg->xDec[zMD].decodeStatus.sourceProgram = PAF_SOURCE_UNKNOWN;
601             TRACE_VERBOSE1("TaskAsip: AS%d: No input selected...", as+zMS);
602             continue;
603         }
604         
605         // if here then we have a valid input so query its status
606         if (errno = pP->fxns->updateInputStatus(pAstCfg->xInp[zMI].hRxSio, &pAstCfg->xInp[zMI].inpBufStatus, &pAstCfg->xInp[zMI].inpBufConfig))
607         {
608             TRACE_VERBOSE1("TaskAsip: continue as updateInputStatus returns 0x%x", errno);
609             continue;
610         }
611         
612         // If master decoder is not enabled, or the input is unlocked, then do nothing
613         if (!pAstCfg->xDec[zMD].decodeStatus.mode || !pAstCfg->xInp[zMI].inpBufStatus.lock)
614         {
615             TRACE_VERBOSE0("TaskAsip: Not locked, continue");
616             continue;
617         }
618         
619         // If no source selected then do nothing
620         if (pAstCfg->xDec[zMD].decodeStatus.sourceSelect == PAF_SOURCE_NONE) 
621         {
622             pAstCfg->xDec[zMD].decodeStatus.sourceProgram = PAF_SOURCE_NONE;
623             TRACE_VERBOSE1("TaskAsip: AS%d: no source selected, continue", as+zMS);
624             continue;
625         }
627         // If we want pass processing then proceed directly
628         if (pAstCfg->xDec[zMD].decodeStatus.sourceSelect == PAF_SOURCE_PASS) 
629         {
630             TRACE_VERBOSE1("TaskAsip: AS%d: Pass processing ...", as+zMS);
631             pAstCfg->xDec[zMD].decodeStatus.sourceProgram = PAF_SOURCE_PASS;
632             pP->fxns->sourceDecode(pP, pQ, pC, PAF_SOURCE_PASS);
633             if (pP->fxns->passProcessing)
634             {
635                 errno = pP->fxns->passProcessing(pP, pQ, pC, NULL);                
636             }
637             else 
638             {
639                 TRACE_TERSE2("TaskAsip: AS%d: Pass Processing not supported, errno 0x%x", as+zMS, ASPERR_PASS);
640                 errno = ASPERR_PASS;
641             }
642             TRACE_VERBOSE0("TaskAsip: continue");
643             continue;
644         }
646         // .....................................................................
647         // At this point we have an enabled input and want to decode something.
648         // If no decoder selected then do nothing. Need to reset the sourceProgram, since
649         // when no decoder is selected there are no calls to IB
650         //if (errno = pP->fxns->autoProcessing(pP, pQ, pC, pC->xDec[zMD].decodeStatus.sourceSelect, pC->xDec[zMD].decAlg[PAF_SOURCE_PCM]))
651         if (errno = pP->fxns->autoProcessing(pP, pQ, pC, pAstCfg->xDec[zMD].decodeStatus.sourceSelect, NULL)) // (***) FL: re-visit this, hard-coded to use PCM framelength inside function
652         {
653             TRACE_VERBOSE1("TaskAsip: autoProcessing returns 0x%x, continue", errno);
654             continue;
655         }
656         
657         // query for input type
658         if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_SOURCEPROGRAM, (Arg )&sourceProgram))
659         {
660             TRACE_TERSE2("TaskAsip: SIO_ctrl returns 0x%x, then 0x%x, continue", errno, ASPERR_AUTO_PROGRAM);
661             errno = ASPERR_AUTO_PROGRAM;
662             continue;
663         }
664         pAstCfg->xDec[zMD].decodeStatus.sourceProgram = sourceProgram;
666         // if input is unclassifiable then do nothing
667         if (sourceProgram == PAF_SOURCE_UNKNOWN)
668         {
669             TRACE_VERBOSE0("TaskAsip: Source program unknown. continue");
670             continue;
671         }
673         // now that we have some input classification, and possibly an outstanding
674         // input frame, we determine whether or not to call decodeProcessing and with
675         // what decAlg.
676         sourceSelect = PAF_SOURCE_NONE;
677         switch (pAstCfg->xDec[zMD].decodeStatus.sourceSelect) 
678         {
679             // If autodetecting, decoding everything, and input is something
680             // (i.e. bitstream or PCM) then decode.
681             case PAF_SOURCE_AUTO:
682                 if (sourceProgram >= PAF_SOURCE_PCM)
683                 {
684                     sourceSelect = sourceProgram;                    
685                 }
686                 break;
688             // If autodetecting, decoding only PCM, and input is PCM then decode.
689             case PAF_SOURCE_PCMAUTO:
690                 if (sourceProgram == PAF_SOURCE_PCM)
691                 {
692                     sourceSelect = sourceProgram;                    
693                 }
694                 break;
696             // If autodetecting, decoding only bitstreams, and input is a bitstream then decode.
697             case PAF_SOURCE_BITSTREAM:
698                 if (sourceProgram >= PAF_SOURCE_AC3)
699                 {
700                     sourceSelect = sourceProgram;                    
701                 }
702                 break;
704             // If autodetecting, decoding only DTS, and input is DTS then decode.
705             case PAF_SOURCE_DTSALL:
706                 switch (sourceProgram) 
707                 {
708                     case PAF_SOURCE_DTS11:
709                     case PAF_SOURCE_DTS12:
710                     case PAF_SOURCE_DTS13:
711                     case PAF_SOURCE_DTS14:
712                     case PAF_SOURCE_DTS16:
713                     case PAF_SOURCE_DTSHD:
714                         sourceSelect = sourceProgram;
715                         break;
716                 }
717                 break;
719             // All others, e.g., force modes, fall through to here.
720             // If user made specific selection then program must match select.
721             // (NB: this compare relies on ordering of PAF_SOURCE)
722             default:
723                 sourceSelect = pAstCfg->xDec[zMD].decodeStatus.sourceSelect;
724                 if ((sourceSelect >= PAF_SOURCE_PCM) && (sourceSelect <= PAF_SOURCE_N))
725                 {
726                     if (sourceProgram != sourceSelect)
727                     {
728                         sourceSelect = PAF_SOURCE_NONE;                        
729                     }
730                 }
731                 break;
732         }
734         // if we didn't find any matches then skip
735         if (sourceSelect == PAF_SOURCE_NONE)
736         {
737             TRACE_VERBOSE0("TaskAsip: no matching source type, continue");
738             continue;
739         }
741         // FL: debug, reset IB capture buffer
742         //capIbReset();
743         //Log_info0("capIbReset()");
744         
745         // FL: send source select message to slave
746         pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize); /* allocate message */
747         MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
748         pAspMsg->cmd = ASP_SLAVE_DEC_SOURCE_SELECT;                                         /* fill in message payload */
749         pAspMsg->procId = hAspMsgMaster->masterProcId;
750         pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
751         pAspMsg->expectResp = TRUE;
752         *(Int32 *)&pAspMsg->buf[0] = sourceSelect;
753         TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
754         TRACE_MSG1("sourceSelect=%d", pAspMsg->buf[0]);
755         status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message */
756         if (status != MessageQ_S_SUCCESS)
757         {
758             SW_BREAKPOINT;
759         }
760         // wait for source select complete message from slave
761         //do {
762         //    status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
763         //} while (status != MessageQ_S_SUCCESS);
764         status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
765         if (status != MessageQ_S_SUCCESS)
766         {
767             TRACE_TERSE0("MessageQ_get() failure.");
768             SW_BREAKPOINT; // temporary
769         }
770         if ((pAspMsg->procId != hAspMsgMaster->slaveProcId) ||
771             (pAspMsg->cmd != ASP_MASTER_DEC_SOURCE_SELECT_DONE) ||
772             (pAspMsg->messageId != (hAspMsgMaster->messageId | ((UInt32)1<<31))))
773         {
774             TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
775             SW_BREAKPOINT;
776         }
777         hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
778         TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
779         status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
780         if (status != MessageQ_S_SUCCESS)
781         {
782             SW_BREAKPOINT;
783         }
784         
785         // set to unknown so that we can ensure, for IOS purposes, that sourceDecode = NONE
786         // iff we are in this top level state machine and specifically not in decodeProcessing
787         pP->fxns->sourceDecode(pP, pQ, pC, PAF_SOURCE_UNKNOWN);
788         
789         TRACE_VERBOSE1(procName[sourceProgram], as+zMS);
791         TRACE_VERBOSE0("TaskAsip: calling decodeProcessing.");
792         errno = pP->fxns->decodeProcessing(pP, pQ, pC, sourceSelect);
793         if (errno) 
794         {
795             TRACE_TERSE1("TaskAsip: decodeProcessing returns 0x%x, continue", errno);
796         }
797         else
798         {
799             TRACE_VERBOSE0("TaskAsip: decodeProcessing complete with no error.");
800         }        
802         // FL: send dec exit message to slave
803         pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize); /* allocate message */
804         MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
805         pAspMsg->cmd = ASP_SLAVE_DEC_EXIT;                                                  /* fill in message payload */
806         pAspMsg->procId = hAspMsgMaster->masterProcId;
807         pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
808         pAspMsg->expectResp = TRUE;
809         TRACE_MSG2("Tx ASP message: procId=%d, cmd=%d.", pAspMsg->procId, pAspMsg->cmd);
810         status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message */
811         if (status != MessageQ_S_SUCCESS)
812         {
813             SW_BREAKPOINT;
814         }
815         // wait for dec exit complete message from slave
816         //do {
817         //    status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
818         //} while ((status < 0) || (pAspMsg->cmd != ASP_MASTER_DEC_EXIT_DONE));
819         status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
820         if (status != MessageQ_S_SUCCESS)
821         {
822             TRACE_TERSE0("MessageQ_get() failure.");
823             SW_BREAKPOINT; // temporary
824         }
825         if ((pAspMsg->procId != hAspMsgMaster->slaveProcId) || 
826             (pAspMsg->cmd != ASP_MASTER_DEC_EXIT_DONE) ||
827             (pAspMsg->messageId != (hAspMsgMaster->messageId | ((UInt32)1<<31))))
828         {
829             TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
830             SW_BREAKPOINT;
831         }
832         hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
833         TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
834         // free the message
835         status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
836         if (status != MessageQ_S_SUCCESS)
837         {
838             SW_BREAKPOINT;
839         }
840     } // End of main processing loop for (;;)
841     
842     Log_info0("Exit taskAsipFxn()");
845 // -----------------------------------------------------------------------------
846 // ASIT Initialization Function - Memory Allocation
847 //
848 //   Name:      PAF_ASIT_initPhaseMalloc
849 //   Purpose:   Audio Stream Input Task Function for initialization of data pointers
850 //              by allocation of memory.
851 //   From:      audioStream1Task or equivalent
852 //   Uses:      See code.
853 //   States:    x
854 //   Return:    0 on success.
855 //              Source code line number on MEM_calloc failure.
856 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
857 //              * State information as per parent.
858 //              * Memory allocation errors.
859 //
860 Int
861 PAF_ASIT_initPhaseMalloc(
862     const PAF_ASIT_Params *pP, 
863     const PAF_ASIT_Patchs *pQ, 
864     PAF_ASIT_Config *pC
867     PAF_AST_Config *pAstCfg;
868     Int as;                    /* Audio Stream Number (1, 2, etc.) */
869     Int zMS;
870     Error_Block    eb;
872     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
873     as = pAstCfg->as;
874     zMS = pAstCfg->masterStr;
875     
876     TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: initialization phase - memory allocation", as+zMS);
878     // Initialize error block
879     Error_init(&eb); 
881     /* Input memory */
882     if (!(pAstCfg->xInp = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, 
883         INPUTN * sizeof (*pAstCfg->xInp), 4, &eb)))
884     {
885         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
886         SW_BREAKPOINT;
887         return __LINE__;
888     }
889     TRACE_TERSE3("PAF_ASIT_initPhaseMalloc. (pC->xInp) %d bytes from space %d at 0x%x.",
890         INPUTN * sizeof (*pAstCfg->xInp),
891         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xInp);
893     /* Decode memory */
894     if (!(pAstCfg->xDec = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, 
895         DECODEN * sizeof (*pAstCfg->xDec), 4, &eb)))
896     {
897         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
898         SW_BREAKPOINT;
899         return __LINE__;
900     }
901     TRACE_TERSE3("PAF_ASIT_initPhaseMalloc. (pC->xDec) %d bytes from space %d at 0x%x.",
902         DECODEN * sizeof (*pAstCfg->xDec),
903         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xDec);
904                 
905     TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: initialization phase - memory allocation complete.", as+zMS);
906     return 0;
907 } //PAF_ASIT_initPhaseMalloc
909 // -----------------------------------------------------------------------------
910 // ASIT Initialization Function - Memory Initialization from Configuration
911 //
912 //   Name:      PAF_ASIT_initPhaseConfig
913 //   Purpose:   Audio Stream Task Function for initialization of data values
914 //              from parameters.
915 //   From:      audioStream1Task or equivalent
916 //   Uses:      See code.
917 //   States:    x
918 //   Return:    0 on success.
919 //              Other as per initFrame0 and initFrame1.
920 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
921 //              * State information as per parent.
922 //
923 Int
924 PAF_ASIT_initPhaseConfig(
925     const PAF_ASIT_Params *pP, 
926     const PAF_ASIT_Patchs *pQ, 
927     PAF_ASIT_Config *pC
930     PAF_AST_Config *pAstCfg;
931     Int as;                    /* Audio Stream Number (1, 2, etc.) */
932     Int z;                     /* input/encode/stream/decode/output counter */
933     Int zMS;
935     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
936     as = pAstCfg->as;
937     zMS = pAstCfg->masterStr;
938     
939     TRACE_TERSE1("PAF_ASIT_initPhaseConfig: AS%d: initialization phase - configuration", as+zMS);
941     //
942     // Unspecified elements have been initialized to zero during alloc
943     //
944     
945     for (z=INPUT1; z < INPUTN; z++) 
946     {
947         pAstCfg->xInp[z].inpBufStatus = *pP->pInpBufStatus;
948         pAstCfg->xInp[z].inpBufConfig.pBufStatus = &pAstCfg->xInp[z].inpBufStatus;
949     }
951     for (z=DECODE1; z < DECODEN; z++) 
952     {
953         Int zI = pP->inputsFromDecodes[z];
954         pAstCfg->xDec[z].decodeControl.size = sizeof(pAstCfg->xDec[z].decodeControl);
955         pAstCfg->xDec[z].decodeControl.pInpBufConfig = (const PAF_InpBufConfig *)&pAstCfg->xInp[zI].inpBufConfig;
956         //pC->xDec[z].decodeStatus = *pP->z_pDecodeStatus[z]; // FL: slave
957     }
959     TRACE_TERSE1("PAF_ASIT_initPhaseConfig: AS%d: initialization phase - configuration complete.", as+zMS);
960     return 0;
961 } //PAF_ASIT_initPhaseConfig
963 // -----------------------------------------------------------------------------
964 // ASIT Initialization Function - ACP Algorithm Instantiation
965 //
966 //   Name:      PAF_ASIT_initPhaseAcpAlg
967 //   Purpose:   Audio Stream Input Task Function for initialization of ACP by
968 //              instantiation of the algorithm.
969 //   From:      audioStream1Task or equivalent
970 //   Uses:      See code.
971 //   States:    x
972 //   Return:    0 on success.
973 //              Source code line number on ACP Algorithm creation failure.
974 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
975 //              * State information as per parent.
976 //              * Memory allocation errors.
977 //
978 Int
979 PAF_ASIT_initPhaseAcpAlg(
980     const PAF_ASIT_Params *pP, 
981     const PAF_ASIT_Patchs *pQ, 
982     PAF_ASIT_Config *pC
985     PAF_AST_Config *pAstCfg;
986     Int as;                 /* Audio Stream Number (1, 2, etc.) */
987     Int z;                  /* input/encode/stream/decode/output counter */
988     Int betaPrimeOffset;
989     ACP_Handle acp;
990     Int zMS;
991     Int zS, zX;
993     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
994     as = pAstCfg->as;
995     zMS = pAstCfg->masterStr;
996     
997     TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: initialization phase - ACP Algorithm", as+zMS);
999     ACP_MDS_init();
1001     if (!(acp = (ACP_Handle)ACP_MDS_create(NULL))) 
1002     {
1003         TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: ACP algorithm instance creation failed", as+zMS);
1004         return __LINE__;
1005     }
1006     pC->acp = acp;
1008     ((ALG_Handle)acp)->fxns->algControl((ALG_Handle) acp,
1009         ACP_GETBETAPRIMEOFFSET, (IALG_Status *)&betaPrimeOffset);
1011     for (z=INPUT1; z < INPUTN; z++) 
1012     {
1013         zS = z;
1014         for (zX = DECODE1; zX < DECODEN; zX++) 
1015         {
1016             if (pP->inputsFromDecodes[zX] == z) 
1017             {
1018                 zS = pP->streamsFromDecodes[zX];
1019                 break;
1020             }
1021         }
1022         acp->fxns->attach(acp, ACP_SERIES_STD,
1023             STD_BETA_IB + betaPrimeOffset * (as-1+zS),
1024             (IALG_Status *)&pAstCfg->xInp[z].inpBufStatus);
1025         /* Ignore errors, not reported. */
1026     }
1028     TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: initialization phase - ACP Algorithm complete.", as+zMS);
1030     return 0;
1031 } //PAF_ASIT_initPhaseAcpAlg
1033 // -----------------------------------------------------------------------------
1034 // ASIT Initialization Function - Common Memory
1035 //
1036 //   Name:      PAF_ASIT_initPhaseCommon
1037 //   Purpose:   Audio Stream Input Task Function for allocation of common memory.
1038 //   From:      audioStream1Task or equivalent
1039 //   Uses:      See code.
1040 //   States:    x
1041 //   Return:    0 on success.
1042 //              Source code line number on PAF_ALG_alloc failure.
1043 //              Source code line number on PAF_ALG_mallocMemory failure.
1044 //              Source code line number on Decode Chain initialization failure.
1045 //              Source code line number on ASP Chain initialization failure.
1046 //              Source code line number on Encode Chain initialization failure.
1047 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1048 //              * State information as per parent.
1049 //              * Memory allocation errors.
1050 //
1051 Int
1052 PAF_ASIT_initPhaseCommon(
1053     const PAF_ASIT_Params *pP, 
1054     const PAF_ASIT_Patchs *pQ, 
1055     PAF_ASIT_Config *pC
1058     PAF_AST_Config *pAstCfg;
1059     Int as;                     /* Audio Stream Number (1, 2, etc.) */
1060     Int z;                      /* stream counter */
1061     ACP_Handle acp;
1062     PAF_IALG_Config pafAlgConfig;
1063     IALG_MemRec common[3][PAF_IALG_COMMON_MEMN+1];
1064    
1065     acp = pC->acp;
1066     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1067     as = pAstCfg->as;
1068     
1069     TRACE_TERSE0("PAF_ASIT_initPhaseCommon: initialization phase - Common Memory");
1071     //
1072     // Determine memory needs and instantiate algorithms across audio streams
1073     //
1074     TRACE_TERSE0("PAF_ASIT_initPhaseCommon: calling PAF_ALG_setup.");
1075     PAF_ALG_setup(&pafAlgConfig, 
1076         HEAP_ID_INTERNAL,       HEAP_INTERNAL, 
1077         HEAP_ID_INTERNAL1,      HEAP_INTERNAL1, 
1078         HEAP_ID_EXTERNAL,       HEAP_EXTERNAL, 
1079         HEAP_ID_INTERNAL1_SHM,  HEAP_INTERNAL1_SHM, 
1080         HEAP_CLEAR);
1082     if (pP->fxns->headerPrint)
1083     {
1084         pP->fxns->headerPrint();        
1085     }
1087     for (z = STREAM1; z < STREAMN; z++) 
1088     {
1089         TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: initialization phase - Common Memory", as+z);
1091         //
1092         // Determine common memory for:
1093         //  (1) Logical Input drivers
1094         //
1095         // Decode Algorithms common memory determined in ASP Slave.
1096         //
1097         PAF_ALG_init(common[z], lengthof(common[z]), COMMONSPACE);
1099         //
1100         // Determine common memory needs of Logical Input driver
1101         //
1103         // really need to loop over all inputs for this stream using the tables
1104         // inputsFromDecodes and streamsFromDecodes. But these don't exist for this
1105         // patch, and not needed for FS11, since there is only one input.
1106         if (INPUT1 <= z && z < INPUTN) 
1107         {
1108             TRACE_TERSE2("PAF_ASIT_initPhaseCommon: AS%d: alloc inpLinkInit common[%d]", as+z, z);
1109             if (PAF_ALG_ALLOC(inpLinkInit[z-INPUT1], common[z]))
1110             {
1111                 TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: PAF_ALG_alloc failed", as+z);
1112                 TRACE_TERSE2("failed to alloc %d bytes from space %d", common[z]->size, (IArg)common[z]->space);
1113                 SW_BREAKPOINT;
1114                 return __LINE__;
1115             }
1116             TRACE_TERSE3("alloced %d bytes from space %d at 0x%x", common[z]->size, common[z]->space, (IArg)common[z]->base);
1117             if (pP->fxns->allocPrint)
1118             {
1119                 pP->fxns->allocPrint((const PAF_ALG_AllocInit *)(inpLinkInit[z-INPUT1]), sizeof (*(inpLinkInit[z-INPUT1])), &pafAlgConfig);
1120             }
1121         }
1122     }
1123     {
1124         // Changes made to share scratch between zones
1125         // Assume maximum 3 zones and scratch common memory is at offset 0;
1126         int max=0;
1127         for (z=STREAM1; z<STREAMN; z++)
1128         {
1129             if (max < common[z][0].size)
1130             {
1131                 max = common[z][0].size;
1132             }
1133         }
1134         common[STREAM1][0].size=max;
1135         for (z=STREAM1+1; z<STREAMN; z++)
1136         {
1137             common[z][0].size = 0;            
1138         }
1139     }
1140         
1141     //
1142     // Allocate common memory for:
1143     //  (1) Logical Input drivers
1144     //
1145     for (z = STREAM1; z < STREAMN; z++) 
1146     {
1147         TRACE_TERSE0("PAF_ASIT_initPhaseCommon: calling PAF_ALG_mallocMemory for common space.");
1148         if (PAF_ALG_mallocMemory(common[z], &pafAlgConfig)) 
1149         {
1150             TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: PAF_ALG_mallocMemory failed", as+z);
1151             TRACE_TERSE3("AS%d: z: %d.  Size 0x%x", as+z, z, common[z][0].size);
1152             SW_BREAKPOINT;
1153             return __LINE__;
1154         }
1155         TRACE_TERSE3("alloced %d bytes from space %d at 0x%x", common[z]->size, common[z]->space, (IArg)common[z]->base);
1156         // share zone0 scratch with all zones 
1157         common[z][0].base = common[0][0].base;
1158         if (pP->fxns->commonPrint)
1159         {
1160             pP->fxns->commonPrint(common[z], &pafAlgConfig);
1161         }
1163         //
1164         // Allocate non-common memories for Logical IO drivers
1165         //    Since these structures are used at run-time we allocate from external memory
1166         if (INPUT1 <= z && z < INPUTN) 
1167         {
1168             PAF_ASP_Chain *chain;
1169             TRACE_TERSE2("PAF_ASIT_initPhaseCommon: AS%d: non-common input chain init for %d",
1170                            as+z, z);
1171             chain = PAF_ASP_chainInit(&pAstCfg->xInp[z].inpChainData, pP->pChainFxns,
1172                         HEAP_EXTERNAL, as+z, acp, &trace,
1173                         inpLinkInit[z-INPUT1], NULL, common[z], &pafAlgConfig);
1174             if (!chain) 
1175             {
1176                 TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: Input chain initialization failed", as+z);
1177                 return __LINE__;
1178             }
1179         }
1180     }
1181     TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: Returning complete.", as+z);
1183     return 0;
1184 } //PAF_ASIT_initPhaseCommon
1186 // (***) FL: candidate for removal
1187 // -----------------------------------------------------------------------------
1188 // ASIT Initialization Function - Algorithm Keys
1189 //
1190 //   Name:      PAF_ASIT_initPhaseAlgKey
1191 //   Purpose:   Audio Stream Input Task Function for initialization of data values
1192 //              from parameters for Algorithm Keys.
1193 //   From:      audioStream1Task or equivalent
1194 //   Uses:      See code.
1195 //   States:    x
1196 //   Return:    0.
1197 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1198 //              * State information as per parent.
1199 //
1200 // .............................................................................
1201 Int
1202 PAF_ASIT_initPhaseAlgKey(
1203     const PAF_ASIT_Params *pP, 
1204     const PAF_ASIT_Patchs *pQ, 
1205     PAF_ASIT_Config *pC
1208     PAF_AST_Config *pAstCfg;
1209     Int as;                    /* Audio Stream Number (1, 2, etc.) */
1211     
1212     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1213     as = pAstCfg->as;
1214     (void)as;  // clear compiler warning in case not used with tracing disabled
1216     TRACE_VERBOSE1("PAF_ASIT_initPhaseAlgKey: AS%d: initialization phase - Algorithm Keys", as);
1218 #if 0 // FL: slave    
1219     for (z=DECODE1; z < DECODEN; z++) 
1220     {
1221         for (s=0; s < pP->pDecAlgKey->length; s++) 
1222         {
1223             if ((pP->pDecAlgKey->code[s].full != 0) &&
1224                 (that = PAF_ASP_chainFind (&pC->xDec[z].decChainData, pP->pDecAlgKey->code[s]))) 
1225             {
1226                 pC->xDec[z].decAlg[s] = (ALG_Handle )that->alg;
1227                 /* Cast in interface, for now --Kurt */
1228             }
1229             else
1230             {
1231                 pC->xDec[z].decAlg[s] = NULL;
1232             }
1233         }
1234     }
1235 #endif
1237     return 0;
1238 } //PAF_ASIT_initPhaseAlgKey
1240 // -----------------------------------------------------------------------------
1241 // ASIT Initialization Function - I/O Devices
1242 //
1243 //   Name:      PAF_ASIT_initPhaseDevice
1244 //   Purpose:   Audio Stream Input Task Function for initialization of I/O Devices.
1245 //   From:      audioStream1Task or equivalent
1246 //   Uses:      See code.
1247 //   States:    x
1248 //   Return:    0 on success.
1249 //              Source code line number on device allocation failure.
1250 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1251 //              * State information as per parent.
1252 //              * Memory allocation errors.
1253 //
1254 Int
1255 PAF_ASIT_initPhaseDevice(
1256     const PAF_ASIT_Params *pP, 
1257     const PAF_ASIT_Patchs *pQ, 
1258     PAF_ASIT_Config *pC
1261     PAF_AST_Config *pAstCfg;
1262     Int as;                             /* Audio Stream Number (1, 2, etc.) */
1263     Int z;                              /* input/output counter */
1264     PAF_SIO_IALG_Obj    *pObj;
1265     PAF_SIO_IALG_Config *pAlgConfig;
1266     PAF_IALG_Config pafAlgConfig;
1269     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1270     as = pAstCfg->as;
1271     (void)as; // clear compiler warning in case not used with tracing disabled
1273     TRACE_TERSE1("PAF_ASIT_initPhaseDevice: AS%d: initialization phase - I/O Devices", as);
1275     if (pP->fxns->bufMemPrint)
1276     {
1277         PAF_ALG_setup (&pafAlgConfig, 
1278             HEAP_ID_INTERNAL,       HEAP_INTERNAL, 
1279             HEAP_ID_INTERNAL1,      HEAP_INTERNAL1,
1280             HEAP_ID_EXTERNAL,       HEAP_EXTERNAL,
1281             HEAP_ID_INTERNAL1_SHM,  HEAP_INTERNAL1_SHM,
1282             HEAP_CLEAR);
1283         TRACE_TERSE2("PAF_ASIT_initPhaseDevice: AS%d: calling PAF_ALG_setup with clear at %d.", as, HEAP_CLEAR);
1284     }
1286     for (z=INPUT1; z < INPUTN; z++) 
1287     {
1288         PAF_InpBufConfig *pConfig = &pAstCfg->xInp[z].inpBufConfig;
1290         pObj = (PAF_SIO_IALG_Obj *)pAstCfg->xInp[z].inpChainData.head->alg;
1291         pAlgConfig = &pObj->config;
1293         pAstCfg->xInp[z].hRxSio = NULL;
1295         pConfig->base.pVoid       = pAlgConfig->pMemRec[0].base;
1296         pConfig->pntr.pVoid       = pAlgConfig->pMemRec[0].base;
1297         pConfig->head.pVoid       = pAlgConfig->pMemRec[0].base;
1298         pConfig->futureHead.pVoid = pAlgConfig->pMemRec[0].base;
1299         pConfig->allocation       = pAlgConfig->pMemRec[0].size;
1300         pConfig->sizeofElement    = 2;
1301         pConfig->precision        = 16;
1303         if (pP->fxns->bufMemPrint)
1304         {
1305             pP->fxns->bufMemPrint(z, pAlgConfig->pMemRec[0].size, PAF_ALG_memSpaceToHeapId(&pafAlgConfig,pAlgConfig->pMemRec[0].space), 0);
1306         }
1307     }
1309     TRACE_TERSE1("PAF_ASIT_initPhaseDevice: AS%d: initialization phase - I/O Devices complete.", as);
1311     return 0;
1312 } //PAF_ASIT_initPhaseDevice
1314 // -----------------------------------------------------------------------------
1315 // ASIT Initialization Function - Decoder Output Circular Buffer
1316 //
1317 //   Name:      PAF_ASIT_initPhaseDecOpCircBuf
1318 //   Purpose:   Audio Stream Input Task Function for initialization of Decoder Output Circular Buffer.
1319 //   From:      audioStream1Task or equivalent
1320 //   Uses:      See code.
1321 //   States:    x
1322 //   Return:    0 on success.
1323 //              Source code line number on device allocation failure.
1324 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1325 //              * State information as per parent.
1326 //              * Memory allocation errors.
1327 //
1328 Int
1329 PAF_ASIT_initPhaseDecOpCircBuf(
1330     const PAF_ASIT_Params *pP, 
1331     const PAF_ASIT_Patchs *pQ, 
1332     PAF_ASIT_Config *pC
1335     PAF_AST_Config *pAstCfg;
1336     PAF_AST_DecOpCircBufCtl *pCbCtl;    /* Decoder output circular buffer control */
1337     PAF_AST_DecOpCircBuf *pCb;          /* Decoder output circular buffer */
1338     Int as;                             /* Audio Stream Number (1, 2, etc.) */
1339     Int zMS;
1340     Int z;                              /* decode counter */
1341     Int errno;                          /* error number */
1342     Error_Block    eb;
1343     Int i;
1345     // FL: (***)revisit
1346     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1347     as = pAstCfg->as;
1348     zMS = pAstCfg->masterStr;
1350     pCbCtl = &pC->pAspmCfg->decOpCircBufCtl; // get pointer to circular buffer control
1351     
1352     /* Decode output circular buffer memory */
1353     if (!(pAstCfg->xDecOpCb = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, 
1354         DECODEN * sizeof (*pAstCfg->xDecOpCb), 4, &eb)))
1355     {
1356         TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1357         SW_BREAKPOINT;
1358         return __LINE__;
1359     }
1360     TRACE_TERSE3("PAF_ASIT_initPhaseDecOpCircBuf. (pC->xDecOpCb) %d bytes from space %d at 0x%x.",
1361         DECODEN * sizeof (*pAstCfg->xDecOpCb),
1362         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xDecOpCb);
1363         
1364     for (z=DECODE1; z < DECODEN; z++)
1365     {
1366         pCb = &pAstCfg->xDecOpCb[z];
1367         
1368         // allocate audio frame circular buffer
1369         if (!(pCb->afCb = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, ASP_DECOP_CB_MAX_NUM_AF * sizeof(PAF_AudioFrame), 4, &eb)))
1370         {
1371             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1372             SW_BREAKPOINT;
1373         }
1374         // allocate audio frame PCM sample pointer array
1375         for (i = 0; i<ASP_DECOP_CB_MAX_NUM_AF; i++)
1376         {
1377             if (!(pCb->afCb[i].data.sample = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, ASP_DECOP_CB_MAX_NUM_PCM_CH * sizeof(PAF_AudioData *), 4, &eb)))
1378             {
1379                 TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1380                 SW_BREAKPOINT;
1381             }
1382             if (!(pCb->afCb[i].data.samsiz = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, ASP_DECOP_CB_MAX_NUM_PCM_CH * sizeof(PAF_AudioSize), 4, &eb)))
1383             {
1384                 TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1385                 SW_BREAKPOINT;
1386             }                
1387         }
1388         // allocate PCM sample buffer
1389         if (!(pCb->pcmBuf = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, ASP_DECOP_CB_PCM_BUF_SZ * sizeof(PAF_AudioData), 4, &eb)))
1390         {
1391             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1392             SW_BREAKPOINT;
1393         }
1394         // allocate Metadata buffers //QIN
1395         if (!(pCb->metaBuf = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, ASP_DECOP_CB_MAX_NUM_AF * PAF_MAX_PRIVATE_MD_SZ * PAF_MAX_NUM_PRIVATE_MD * sizeof(Int8), 4, &eb)))
1396         {
1397             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1398             SW_BREAKPOINT;
1399         }
1400         
1401         // (***) FL: revisit, here PCM is hard-coded for 256 sample dec op frame length        
1402         // Initialize decoder output circular buffer for PCM
1403         errno = cbInit(pCbCtl, z, PAF_SOURCE_PCM, 256, FRAMELENGTH, 1);
1404         if (errno)
1405         {
1406             SW_BREAKPOINT; // FL: debug
1407             return errno;
1408         }
1409         // FL: debug
1410         cbLog(pCbCtl, z, 1, "PAF_ASIT_initPhaseDecOpCircBuf:cbInit");        
1411     }
1413     return 0;
1414 } //PAF_ASIT_initPhaseDecOpCircBuf
1417 #if 0
1418 // -----------------------------------------------------------------------------
1419 // AST Processing Function - Pass-Through Processing
1420 //
1421 //   Name:      PAF_AST_passProcessing
1422 //   Purpose:   Audio Stream Task Function for processing audio data as a
1423 //              pass-through from the input driver to the output driver
1424 //              for development and testing.
1425 //   From:      audioStream1Task or equivalent
1426 //   Uses:      See code.
1427 //   States:    x
1428 //   Return:    Error number in standard form (0 on success).
1429 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1430 //              * State information on initialization.
1431 //              * State information on processing.
1432 //
1434 #pragma CODE_SECTION(PAF_AST_passProcessing,".text:_PAF_AST_passProcessing")
1435 /* Pass Processing is often omitted from builds to save memory, */
1436 /* and CODE_SECTION/clink constructs facilitate this omission.  */
1438 Int
1439 PAF_AST_passProcessing(const PAF_AST_Params *pP, const PAF_AST_Patchs *pQ, PAF_AST_Config *pC, Int hack)
1441     Int z;                              /* input/output counter */
1442     Int errno = 0;                      /* error number */
1443     Int getVal;
1444     Int rxNumChan, txNumChan;
1445     Int first;
1446     Int zMD = pC->masterDec;
1447     Int zMI = pP->zone.master;
1450 #ifndef __TI_EABI__
1451     asm (" .clink"); /* See comment above regarding CODE_SECTION/clink. */
1452 #endif    
1454     TRACE_VERBOSE0("PAF_AST_passProcessing: initializing");
1456     //
1457     // Determine that receive/transmit channels are compatible
1458     //
1460     // Can handle handle only master input
1461     for (z=INPUT1; z < INPUTN; z++) {
1462         if (z != zMI && pC->xInp[z].hRxSio)
1463             return (ASPERR_PASS + 0x01);
1464     }
1466     /* Number of receive/transmit channels */
1468     if (! pC->xInp[zMI].hRxSio)
1469         return (ASPERR_PASS + 0x11);
1470     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &rxNumChan))
1471         return (ASPERR_PASS + 0x12);
1472     if (rxNumChan > NUM_TX_CHAN(zMI))
1473         return (ASPERR_PASS + 0x13);
1475     for (z=OUTPUT1; z < OUTPUTN; z++) {
1476         if (! pC->xOut[zMI].hTxSio)
1477             return (ASPERR_PASS + 0x10*(z+2) + 0x01);
1478         if (SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &txNumChan))
1479             return (ASPERR_PASS + 0x10*(z+2) + 0x02);
1480         if (txNumChan > NUM_TX_CHAN(zMI))
1481             return (ASPERR_PASS + 0x10*(z+2) + 0x03);
1482     }
1484     //
1485     // Set up receive/transmit
1486     //
1488     SIO_idle (pC->xInp[zMI].hRxSio);
1489     for (z=OUTPUT1; z < OUTPUTN; z++) {
1490         if(SIO_idle (pC->xOut[z].hTxSio))
1491             return ASPERR_IDLE;
1492     }
1494     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_SET_SOURCESELECT, PAF_SOURCE_PCM))
1495         return (ASPERR_PASS + 0x14);
1497     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, FRAMELENGTH))
1498         return (ASPERR_PASS + 0x15);
1500     for (z=OUTPUT1; z < OUTPUTN; z++)
1501         pC->xOut[z].outBufConfig.lengthofFrame = FRAMELENGTH;
1503     if (SIO_issue (pC->xInp[zMI].hRxSio, &pC->xInp[zMI].inpBufConfig, sizeof (pC->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_SYNC))
1504         return ASPERR_PASS + 0x16;
1506     if (SIO_reclaim (pC->xInp[zMI].hRxSio, (Ptr)&pC->xInp[zMI].pInpBuf, NULL) != sizeof (PAF_InpBufConfig))
1507         return ASPERR_PASS + 0x17;
1509     //
1510     // Receive and transmit the data in single-frame buffers
1511     //
1513     first = 1;
1514     while (pC->xDec[zMD].decodeStatus.sourceSelect == PAF_SOURCE_PASS) {
1515         PAF_OutBufConfig *pOutBuf;
1516         PAF_InpBufConfig *pInpBuf;
1518         if (first) {
1519             first = 0;
1521             TRACE_VERBOSE0("PAF_AST_passProcessing: starting output");
1523             for (z=OUTPUT1; z < OUTPUTN; z++) {
1524                 getVal = SIO_issue (pC->xOut[z].hTxSio, &pC->xOut[z].outBufConfig, sizeof(pC->xOut[z].outBufConfig), 0);
1525                 if (getVal > 0) {
1526                     errno = ASPERR_ISSUE;
1527                     break;
1528                 }
1529                 else if (getVal < 0) {
1530                     errno = -getVal;
1531                     break;
1532                 }
1534                 if (getVal = SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_UNMUTE, 0))
1535                     return (getVal & 0xff) | ASPERR_MUTE;
1536             }
1537             if (errno)
1538                 break;
1540         }
1542         getVal = SIO_issue (pC->xInp[zMI].hRxSio, &pC->xInp[zMI].inpBufConfig, sizeof (pC->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME);
1543         if (getVal > 0) {
1544             errno = ASPERR_ISSUE;
1545             break;
1546         }
1548         TRACE_VERBOSE1("PAF_AST_passProcessing: awaiting frame -- input size %d", rxNumChan * FRAMELENGTH);
1550         getVal = SIO_reclaim (pC->xInp[zMI].hRxSio, (Ptr) &pInpBuf, NULL);
1551         if (getVal < 0) {
1552             errno = -getVal;
1553             break;
1554         }
1556         for (z=OUTPUT1; z < OUTPUTN; z++) {
1557             getVal = SIO_reclaim (pC->xOut[z].hTxSio, (Ptr) &pOutBuf, NULL);
1558             if (getVal < 0) {
1559                 errno = -getVal;
1560                 break;
1561             }
1562         }
1563         if( errno )
1564             break;
1566         TRACE_VERBOSE0("PAF_AST_passProcessing: copying frame");
1568         if (errno = pP->fxns->passProcessingCopy (pP, pQ, pC))
1569             break;
1571         for (z=OUTPUT1; z < OUTPUTN; z++) {
1572             getVal = SIO_issue (pC->xOut[z].hTxSio, &pC->xOut[z].outBufConfig, sizeof(pC->xOut[z].outBufConfig), 0);
1573             if (getVal > 0) {
1574                 errno = ASPERR_ISSUE;
1575                 break;
1576             }
1577             else if (getVal < 0) {
1578                 errno = -getVal;
1579                 break;
1580             }
1581         }
1582         if( errno )
1583             break;
1584     }
1586     //
1587     // Close down receive/transmit
1588     //
1590     TRACE_TERSE0("PAF_AST_passProcessing: finalizing"));
1592     for (z=OUTPUT1; z < OUTPUTN; z++) {
1593         if (getVal = SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_MUTE, 0)) {
1594             if (! errno)
1595                 errno = (getVal & 0xff) | ASPERR_MUTE;
1596             /* convert to sensical errno */
1597         }
1598     }
1600     SIO_idle (pC->xInp[zMI].hRxSio);
1601     for (z=OUTPUT1; z < OUTPUTN; z++)
1602         SIO_idle (pC->xOut[z].hTxSio);
1604     return errno;
1606 } //PAF_AST_passProcessing
1607 #endif // #if 0
1609 #if 0
1610 // -----------------------------------------------------------------------------
1611 // AST Processing Function Helper - Pass-Through Processing Patch Point
1612 //
1613 //   Name:      PAF_AST_passProcessingCopy
1614 //   Purpose:   Pass-Through Processing Function for copying audio data
1615 //              from the input buffer to the output buffer.
1616 //   From:      AST Parameter Function -> passProcessing
1617 //   Uses:      See code.
1618 //   States:    x
1619 //   Return:    Error number in standard form (0 on success).
1620 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1621 //              x
1622 //
1624 #pragma CODE_SECTION(PAF_AST_passProcessingCopy,".text:_PAF_AST_passProcessingCopy")
1625 /* Pass Processing is often omitted from builds to save memory, */
1626 /* and CODE_SECTION/clink constructs facilitate this omission.  */
1628 Int
1629 PAF_AST_passProcessingCopy (const PAF_AST_Params *pP, const PAF_AST_Patchs *pQ, PAF_AST_Config *pC)
1631     Int z;                              /* output counter */
1632     Int errno;                          /* error number */
1633     Int i;
1634     Int rxNumChan, txNumChan;
1635     Int zMI = pP->zone.master;
1638     asm (" .clink"); /* See comment above regarding CODE_SECTION/clink. */
1640     // Copy data from input channels to output channels one of two ways:
1642     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &rxNumChan))
1643         return (ASPERR_PASS + 0x12);
1645     for (z=OUTPUT1; z < OUTPUTN; z++) {
1646         if (SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &txNumChan))
1647             return (ASPERR_PASS + 0x22);
1649         if( txNumChan <= rxNumChan ) {
1651             // Copy one to one, ignoring later rx channels as needed.
1653             for( i=0; i < txNumChan; i++ ) {
1654                 errno = pP->fxns->copy( i, &pC->xInp[zMI].inpBufConfig, i, &pC->xOut[z].outBufConfig );
1655                 if( errno )
1656                     return errno;
1657             }
1658         }
1659         else {
1661             // Copy one to many, repeating earlier rx channels as needed.
1663             Int from, to;
1665             from = 0;
1666             to   = 0;
1667             while( to < txNumChan ) {
1668                 errno = pP->fxns->copy( from, &pC->xInp[zMI].inpBufConfig, to, &pC->xOut[z].outBufConfig );
1669                 if( errno )
1670                     return errno;
1672                 from++;
1673                 to++;
1674                 if( from == rxNumChan )
1675                     from = 0;
1676             }
1677         }
1678     }
1680     return 0;
1681 } //PAF_AST_passProcessingCopy
1682 #endif // #if 0
1684 // -----------------------------------------------------------------------------
1685 // ASIT Processing Function - Auto Processing
1686 //
1687 //   Name:      PAF_ASIT_autoProcessing
1688 //   Purpose:   Audio Stream Input Task Function for processing audio data to
1689 //              determine the input type without output.
1690 //   From:      audioStream1Task or equivalent
1691 //   Uses:      See code.
1692 //   States:    x
1693 //   Return:    Error number in standard or SIO form (0 on success).
1694 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1695 //              * State information on initialization.
1696 //
1698 #define DECSIOMAP(X)                                                \
1699     pP->pDecSioMap->map[(X) >= pP->pDecSioMap->length ? 0 : (X)]
1701 Int
1702 PAF_ASIT_autoProcessing(
1703     const PAF_ASIT_Params *pP, 
1704     const PAF_ASIT_Patchs *pQ, 
1705     PAF_ASIT_Config *pC, 
1706     Int inputTypeSelect, 
1707     ALG_Handle pcmAlgMaster
1710     PAF_AST_Config *pAstCfg;
1711     Int as;                 /* Audio Stream Number (1, 2, etc.) */
1712     Int errno = 0;          /* error number */
1713     Int nbytes;
1714     Int frameLength;
1715     Int zMD;
1716     Int zMI;
1717     Int zMS;
1718     
1719     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1720     as = pAstCfg->as;
1721     zMD = pAstCfg->masterDec;
1722     zMS = pAstCfg->masterStr;    
1723     zMI = pP->zone.master;    
1724     
1725     TRACE_VERBOSE1("PAF_ASIT_autoProcessing: AS%d: PAF_AST_autoProcessing", as+zMS);
1727     if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio,
1728                          PAF_SIO_CONTROL_SET_SOURCESELECT,
1729                          DECSIOMAP(pAstCfg->xDec[zMD].decodeStatus.sourceSelect)))
1730     {
1731         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: AS%d: source select returns 0x%x", as+zMS, errno);
1732         return errno;
1733     }
1734     //frameLength = pP->fxns->computeFrameLength (pcmAlgMaster, FRAMELENGTH,
1735     //                                            pC->xDec[zMD].decodeStatus.bufferRatio);
1736     frameLength = FRAMELENGTH; // FL: fix PCM frameLength for alpha release.
1738     if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio,
1739                          PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, frameLength))
1740     {
1741         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: SET_PCMFRAMELENGTH returns 0x%x, returning ASPERR_AUTO_LENGTH, 0x%x",
1742             errno, ASPERR_AUTO_LENGTH);
1743         return ASPERR_AUTO_LENGTH;
1744     }
1746     if (errno = SIO_issue(pAstCfg->xInp[zMI].hRxSio,
1747                           &pAstCfg->xInp[zMI].inpBufConfig, sizeof(pAstCfg->xInp[zMI].inpBufConfig),
1748                           PAF_SIO_REQUEST_SYNC))
1749     {
1750         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: REQUEST_SYNC returns 0x%x, returning ASPERR_ISSUE, 0x%x",
1751             errno, ASPERR_ISSUE);
1752         return ASPERR_ISSUE;
1753     }
1755     TRACE_VERBOSE1("PAF_ASIT_autoProcessing: AS%d: awaiting sync", as+zMS);
1757     // all of the sync scan work is done in this call. If the error returned
1758     // is DIBERR_SYNC then that just means we didn't find a sync, not a real I/O
1759     // error so we mask it off.
1760     nbytes = SIO_reclaim(pAstCfg->xInp[zMI].hRxSio, (Ptr)&pAstCfg->xInp[zMI].pInpBuf, NULL);
1761     if (nbytes == -DIBERR_SYNC)
1762     {
1763         TRACE_TERSE2("PAF_ASIT_autoProcessing: AS%d: SIO_reclaim returned 0x%x, ignoring", as+zMS, nbytes);
1764         return 0;
1765     }
1766     if (nbytes != sizeof(PAF_InpBufConfig))
1767     {
1768         TRACE_TERSE3("PAF_ASIT_autoProcessing. SIO_reclaim returned %d, not %d, returning ASPERR_RECLAIM (0x%x)",
1769             nbytes, sizeof(PAF_InpBufConfig), ASPERR_RECLAIM);
1770         return ASPERR_RECLAIM;
1771     }
1772     if (errno)
1773     {
1774         TRACE_TERSE2("PAF_ASIT_autoProcessing: AS%d: returning errno 0x%x", as+zMS, errno);
1775     }
1776     return errno;
1777 } //PAF_ASIT_autoProcessing
1779 // -----------------------------------------------------------------------------
1780 // ASIT Processing Function - Decode Processing
1781 //
1782 //   Name:      PAF_ASIT_decodeProcessing
1783 //   Purpose:   Audio Stream Input Task Function for processing audio data.
1784 //   From:      audioStream1Task or equivalent
1785 //   Uses:      See code.
1786 //   States:    x
1787 //   Return:    Error number in standard form (0 on success).
1788 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1789 //              * State information on initialization (via children).
1790 //              * State information on processing (via children).
1791 //              * Decode warnings.
1792 //
1793 // When "writeDECModeContinuous" is used for zMI input/decode:
1794 // PAF_AST_decodeProcessing() loop may be (is designed to be) exited:
1795 // (a) if "writeDECCommandRestart" is used
1796 //    (or "writeDECCommandAbort", but this performs no cleanup whatsoever, and so its use is discouraged)
1797 // (b) if "writeDECSourceSelectNone" is used
1798 // [ the latter events lead to QUIT state, simply for exiting (errme = errno = ASPERR_QUIT)
1799 // (c) if an error occurs in
1800 //     INIT
1801 //     CONT ("subsequent block state", which "Establish[es] secondary timing")
1802 //         -> PAF_AST_decodeCont(): "Await slave inputs"
1803 //     STREAM (errno |= PAF_COMPONENT_ASP)
1804 //     ENCODE (errno |= PAF_COMPONENT_ENCODE)
1805 // [ the latter errors lead to "switch_break:"
1806 //         -> PAF_AST_decodeComplete(), which always returns 0 (no error) ]
1807 //
1808 // [ Notably, in FINAL ("frame-finalization state")
1809 //         -> PAF_AST_decodeFinalTest() is *not* called,
1810 //   and so any other (asynchronous) changes in pC->xDec[zMD].decodeStatus.sourceSelect are ignored. ]
1811 // [ For completeness, note also: "default" state, internal check (errme = errno = ASPERR_UNKNOWNSTATE) ]
1812 //
1813 // States in which error can't occur:
1814 //     AGAIN ("subsequent initial state")
1815 //
1816 // States in which (some) errors must be handled:
1817 //     INFO1 ("first frame state")
1818 //         -> PAF_AST_decodeInfo(): pass on ASPERR_INFO_RATECHANGE, ASPERR_INFO_PROGRAM ("bad" internal error)
1819 //            -> *DONE* must "catch" ASPERR_RECLAIM from SIO_reclaim (pC->xInp[zMI].hRxSio) -- note zMI only **
1820 //               ?*? but what about ASPERR_RESYNC from same call ?*?
1821 //            -> *for now, at least, pass on error from pP->fxns->updateInputStatus ()*
1822 //            -> *DONE* must "catch" error from (zMI) dec->fxns->info() **
1823 //         -> PAF_AST_decodeInfo1(): pass on any errors which occur here:
1824 //            - pP->fxns->streamChainFunction (... PAF_ASP_CHAINFRAMEFXNS_RESET)
1825 //            - enc->fxns->info()
1826 //            - pP->fxns->setCheckRateX()
1827 //            - pP->fxns->startOutput()
1828 //            - "Start slave inputs if necessary"
1829 //     INFO2 ("subsequent frame state")
1830 //         -> PAF_AST_decodeInfo(): (see above)
1831 //         -> PAF_AST_decodeInfo2(): pass on any errors which occur here:
1832 //            - pP->fxns->setCheckRateX()
1833 //     TIME ("timing state")
1834 //         -> PAF_AST_decodeTime(): "Special timing consideations for AC-3"
1835 //         -> performs SIO_issue (... PAF_SIO_REQUEST_FULLFRAME) & SIO_reclaim() *for zMI only*
1836 //         -> now, DIB_issue [PAF_SIO_REQUEST_FULLFRAME] would only return SYS_EINVAL for "bad" internal error
1837 //            (*OK* don't try to recover from this*)
1838 //         -> much more likely would be SIO_reclaim() error (ASPERR_RECLAIM)
1839 //         -> *DONE* must "catch" (just) ASPERR_RECLAIM error -- note zMI only,
1840 //            possibly in PAF_AST_decodeProcessing() itself **
1841 //     DECODE ("decode state")
1842 //         -> PAF_AST_decodeDecode(): pass on error from
1843 //            - PAF_SIO_CONTROL_GET_NUM_REMAINING ("bad" internal error)
1844 //            - dec->fxns->reset()
1845 //            - PAF_SIO_CONTROL_SET_PCMFRAMELENGTH
1846 //         -> *DONE* must catch error from (zMI) dec->fxns->decode()
1847 //         -> *?* must catch ASPERR_ISSUE from (zMI) SIO_issue()
1848 Int
1849 PAF_ASIT_decodeProcessing(
1850     const PAF_ASIT_Params *pP, 
1851     const PAF_ASIT_Patchs *pQ, 
1852     PAF_ASIT_Config *pC, 
1853     Int sourceSelect
1856     PAF_AST_Config *pAstCfg;
1857     //Int as = pC->as;                    /* Audio Stream Number (1, 2, etc.) */
1858     Int z;                              /* decode counter */
1859     Int errno;                          /* error number */
1860     Int getVal;
1861     enum { INIT, INFO1, INFO2, DECODE, FINAL, QUIT } state;
1862     ALG_Handle alg[DECODEN_MAX];
1863     Int zMD;
1864     Int zMS;
1865     Int size;
1866     //PAF_InpBufConfig *pIpBufConfig;
1867     Int frame; // decoder input frame count
1868     Int block; // (***) FL: formerly  -- decoder output block count / input frame
1870     
1871     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
1872     zMD = pAstCfg->masterDec;
1873     zMS = pAstCfg->masterStr;
1874         
1875     for (z=DECODE1; z < DECODEN; z++)
1876     {
1877         alg[z] = pAstCfg->xDec[z].decAlg[PAF_SOURCE_PCM];        
1878     }
1879     alg[zMD] = NULL; // decAlgMaster; // FL: alg[] init is on slave
1881     //
1882     // Receive and process the data in single-frame buffers
1883     //
1885     state = INIT;
1886     errno = 0; /* error number */
1888     TRACE_TERSE1("PAF_ASIT_decodeProcessing: sourceSelect is %d", pAstCfg->xDec[zMD].decodeStatus.sourceSelect);
1890     for (;;) 
1891     {
1892         if (pAstCfg->xDec[zMD].decodeStatus.sourceSelect == PAF_SOURCE_NONE)
1893         {
1894             TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: sourceSelect == PAF_SOURCE_NONE");
1895             state = QUIT;
1896         }
1898         // Process commands (decode)
1899         if (getVal = pP->fxns->decodeCommand(pP, pQ, pC)) 
1900         {
1901             if (state != INIT)   // no need to restart/abort if not yet started
1902             {
1903                 if (getVal == ASPERR_QUIT)
1904                 {
1905                     state = QUIT;
1906                     TRACE_VERBOSE0("PAF_ASIT_decodeProcessing. %d: state = QUIT");
1907                 }
1908                 else if (getVal == ASPERR_ABORT)
1909                 {
1910                     TRACE_VERBOSE0("PAF_ASIT_decodeProcessing. %d: return getVal");
1911                     return getVal;
1912                 }
1913                 else
1914                 {
1915                     /* ignore */;
1916                 }
1917             }
1918             TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state == INIT");
1919         }
1921         TRACE_TIME((&TIME_MOD,         "... + %d = %d ->", dtime(), TSK_time()));
1922         TRACE_TIME((&TIME_MOD,         "                 state = %s", stateName[state]));
1924         // Process state (decode)
1925         switch (state) 
1926         {
1927             case INIT: // initial state
1928                 gAsipInitCnt++;
1929                 Log_info0("TaskAsip: state=INIT");
1931                 // (***) FL: revisit
1932 #if 1 // status for shared beta units can change (e.g. at-boot or alpha)
1933                 // write back Status structures for shared Beta Units
1934                 //size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]->size;
1935                 //Cache_wb((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), size, Cache_Type_ALLD, 0);
1936                 size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]->size;
1937                 Cache_wb((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), size, Cache_Type_ALLD, 0);
1938                 size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]->size;
1939                 Cache_wb((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), size, Cache_Type_ALLD, 0);
1940                 Cache_wait();
1941 #endif
1942 #if 0
1943                 ////size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]->size;
1944                 ////Cache_wbInv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), size, Cache_Type_ALLD, 0);
1945                 //size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]->size;
1946                 //Cache_wbInv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), size, Cache_Type_ALLD, 0);
1947                 //size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]->size;
1948                 //Cache_wbInv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), size, Cache_Type_ALLD, 0);
1949                 //Cache_wait();                
1950 #endif                
1951                 
1952                 if (errno = pP->fxns->decodeInit(pP, pQ, pC, sourceSelect))
1953                 {
1954                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INIT, errno 0x%x.  break after decodeInit", errno);
1955                     break;
1956                 }
1957                 
1958 #if 1
1959                 // (***) FL: revisit
1960                 // invalidate Status structures for shared Beta Units
1961                 //size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]->size;
1962                 //Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), size, Cache_Type_ALLD, 0);
1963                 size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]->size;
1964                 Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), size, Cache_Type_ALLD, 0);
1965                 size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]->size;
1966                 Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), size, Cache_Type_ALLD, 0);
1967                 Cache_wait();
1968 #endif
1969                 
1970                 frame = 0;
1971                 block = 0;
1973                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INIT->INFO1");
1974                 state = INFO1;
1975                 continue;
1977             case INFO1: // first frame state
1978                 gAsipInfo1Cnt++;
1979                 Log_info0("TaskAsip: state=INFO1");
1980                 
1981 #if 0
1982                 //// (***) FL: revisit
1983                 //// write back Inp configuration
1984                 //Cache_wb(&gPAF_AST_config.xInp[0], INPUTN*sizeof(PAF_AST_InpBuf), Cache_Type_ALLD, 0);
1985                 //// write back input data
1986                 //pIpBufConfig = &gPAF_AST_config.xInp[0].inpBufConfig;
1987                 //size = pIpBufConfig->frameLength * pIpBufConfig->sizeofElement;
1988                 //Cache_wb(pIpBufConfig->pntr.pLgInt, size, Cache_Type_ALLD, 0);
1989                 //// write back Dec configuration
1990                 //Cache_wb(&gPAF_AST_config.xDec[0], DECODEN*sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
1991                 //Cache_wait();            
1992 #endif                
1994                 // Establish primary timing
1995                 if (errno = pP->fxns->decodeInfo(pP, pQ, pC, frame, block))
1996                 {
1997                     TRACE_TERSE1("INFO1: errno 0x%x after decodeInfo, primary timing", errno);
1998                     break;
1999                 }
2000                 
2001 #if 0
2002                 //// (***) FL: revisit
2003                 //// invalidate Dec configuration
2004                 //Cache_inv(&gPAF_AST_config.xDec[0], DECODEN*sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2005                 //Cache_wait();                            
2006 #endif                
2008                 // Don't start decode until major access unit is found.
2009                 if (((pAstCfg->xDec[zMD].decodeStatus.sourceDecode == PAF_SOURCE_THD)    ||
2010                      (pAstCfg->xDec[zMD].decodeStatus.sourceDecode == PAF_SOURCE_DXP)    ||
2011                      (pAstCfg->xDec[zMD].decodeStatus.sourceDecode == PAF_SOURCE_DTSHD)) &&
2012                      (pAstCfg->xStr[zMS].pAudioFrame->sampleRate == PAF_SAMPLERATE_UNKNOWN)) 
2013                 {
2014                     Int z;
2015                     for (z=DECODE1; z < DECODEN; z++) 
2016                     {
2017                         Int zI = pP->inputsFromDecodes[z];
2018                         if (pAstCfg->xInp[zI].hRxSio && pAstCfg->xDec[z].decodeStatus.mode)
2019                         {
2020                             TRACE_VERBOSE0("TaskAsip: PAF_ASIT_decodeProcessing: INFO1, SIO_issue");
2021                             if (SIO_issue(pAstCfg->xInp[zI].hRxSio, &pAstCfg->xInp[zI].inpBufConfig,
2022                                 sizeof(pAstCfg->xInp[zI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME))
2023                             {
2024                                 TRACE_TERSE0("PAF_ASIT_decodeProcessing. %d: INFO1, return (ASPERR_ISSUE)");
2025                                 return (ASPERR_ISSUE);
2026                             }
2027                         }
2028                     }
2029                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1: frame %d, not major access unit", frame);
2030                     frame++;
2031                     state = INFO1;
2032                     continue;
2033                 }
2034                 TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1: frame %d, major access unit found", frame);
2036                 // Establish secondary timing
2037                 if (errno = pP->fxns->decodeInfo1(pP, pQ, pC, frame, block))
2038                 {
2039                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1, errno 0x%x.  break after decodeInfo1", errno);
2040                     break;
2041                 }
2043                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INFO1->DECODE");
2044                 state = DECODE;
2045                 continue;
2047             case INFO2: // subsequent frame state
2048                 gAsipInfo2Cnt++;
2049                 Log_info0("TaskAsip: state=INFO2");
2051 #if 0            
2052                 //// (***) FL: revisit
2053                 //// write back Inp configuration
2054                 //Cache_wb(&gPAF_AST_config.xInp[0], INPUTN*sizeof(PAF_AST_InpBuf), Cache_Type_ALLD, 0);
2055                 //// write back input data
2056                 //pIpBufConfig = &gPAF_AST_config.xInp[0].inpBufConfig;
2057                 //size = pIpBufConfig->frameLength * pIpBufConfig->sizeofElement;
2058                 //Cache_wb(pIpBufConfig->pntr.pLgInt, size, Cache_Type_ALLD, 0);
2059                 //// write back Dec configuration
2060                 //Cache_wb(&gPAF_AST_config.xDec[0], DECODEN*sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2061                 //Cache_wait();
2062 #endif                
2064                 // Establish primary timing
2065                 if (errno = pP->fxns->decodeInfo(pP, pQ, pC, frame, block))
2066                 {
2067                     TRACE_TERSE1("PAF_ASIT_decodeProcessing: INFO2 break on decodeInfo. errno 0x%x", errno);
2068                     break;
2069                 }
2071 #if 0            
2072                 //// (***) FL: revisit
2073                 //// invalidate Dec configuration
2074                 //Cache_inv(&gPAF_AST_config.xDec[0], DECODEN*sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2075                 //Cache_wait();                                            
2076 #endif                
2077                 
2078                 if (errno = pP->fxns->decodeInfo2(pP, pQ, pC, frame, block))
2079                 {
2080                     TRACE_TERSE1("PAF_ASIT_decodeProcessing. %d: INFO2 break on decodeInfo2. errno 0x%x", errno);
2081                     break;
2082                 }
2084                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INFO2->DECODE");
2085                 state = DECODE;
2086                 continue;
2088             case DECODE: // decode state
2089                 gAsipDecodeCnt++;
2090                 Log_info0("TaskAsip: state=DECODE");
2092 #if 0
2093                 //// (***) FL: revisit
2094                 //// write back Dec configuration
2095                 //Cache_wb(&gPAF_AST_config.xDec[0], DECODEN*sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2096                 //Cache_wait();                        
2097 #endif
2098             
2099                 if (errno = pP->fxns->decodeDecode(pP, pQ, pC, sourceSelect, frame, block))
2100                 {
2101                     TRACE_TERSE1("PAF_ASIT_decodeProcessing: state: DECODE.  decodeDecode err 0x%04x", errno);
2102                     break;
2103                 }
2104       
2105 #if 0      
2106                 //// (***) FL: revisit
2107                 //// invalidate Dec configuration
2108                 //Cache_inv(&gPAF_AST_config.xDec[0], DECODEN*sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2109                 //Cache_wait();                                            
2110 #endif                
2111                 
2112                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: DECODE->FINAL");
2113                 state = FINAL;
2114                 continue;
2116             case FINAL: // frame-finalization state
2117                 gAsipFinalCnt++;
2118                 Log_info0("TaskAsip: state=FINAL");
2120                 // Check for final frame, and if indicated:
2121                 // - Exit state machine to "complete" processing.
2122                 if (pP->fxns->decodeFinalTest(pP, pQ, pC, frame, block)) 
2123                 {
2124                     break;
2125                 }
2127                 frame++;
2128                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: FINAL->AGAIN");
2129                 state = INFO2;
2130                 continue;
2132             case QUIT: // exit state
2133                 gAsipQuitCnt++;
2134                 Log_info0("TaskAsip: state=QUIT");
2136                 // Quit:
2137                 // - Set error number registers.
2138                 // - Exit state machine to "decode complete" processing.
2139                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: QUIT");
2140                 errno = ASPERR_QUIT;
2141                 break;
2143             default: // unknown state
2145                 // Unknown:
2146                 // - Set error number registers.
2147                 // - Exit state machine to "decode complete" processing.
2149                 TRACE_TERSE1("PAF_ASIT_decodeProcessing: state: unknown, 0x%x", state);
2150                 errno = ASPERR_UNKNOWNSTATE;
2151                 break;
2153         }  // End of switch (state).
2155         TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: Calling decode complete");
2156         if (pP->fxns->decodeComplete(pP, pQ, pC, alg, frame, block))
2157         {
2158             /* ignored? */;
2159         }
2161         TRACE_TIME((&TIME_MOD, "as1-f2: ... + %d = ?? (final? %d)", dtime(), state == FINAL));
2163         return errno;
2164     }  // End of for (;;) to Receive, process, and transmit the data.
2165 } //PAF_ASIT_decodeProcessing
2167 // -----------------------------------------------------------------------------
2168 // ASIT Decoding Function - Decode Command Processing
2169 //
2170 //   Name:      PAF_ASIT_decodeCommand
2171 //   Purpose:   Decoding Function for processing Decode Commands.
2172 //   From:      AST Parameter Function -> decodeProcessing
2173 //   Uses:      See code.
2174 //   States:    x
2175 //   Return:    Error number in standard form (0 on success).
2176 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2177 //              * Command execution.
2178 //
2180 Int
2181 PAF_ASIT_decodeCommand(
2182     const PAF_ASIT_Params *pP, 
2183     const PAF_ASIT_Patchs *pQ, 
2184     PAF_ASIT_Config *pC
2187     PAF_AST_Config *pAstCfg;
2188     Int as;                 /* Audio Stream Number (1, 2, etc.) */
2189     Int z;                  /* decode counter */
2190     Int zS;
2192     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
2193     as = pAstCfg->as;
2195     for (z=DECODE1; z < DECODEN; z++) 
2196     {
2197         zS = pP->streamsFromDecodes[z];
2198         if (!(pAstCfg->xDec[z].decodeStatus.command2 & 0x80)) 
2199         {
2200             switch (pAstCfg->xDec[z].decodeStatus.command2) 
2201             {
2202                 case 0: // command none - process
2203                     pAstCfg->xDec[z].decodeStatus.command2 |= 0x80;
2204                     break;
2205                 case 1: // command abort - leave now
2206                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command abort (0x%02x)", as+zS, 1);
2207                     pAstCfg->xDec[z].decodeStatus.command2 |= 0x80;
2208                     return (ASPERR_ABORT);
2209                 case 2: // command restart - leave later
2210                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command quit (0x%02x)", as+zS, 2);
2211                     pAstCfg->xDec[z].decodeStatus.command2 |= 0x80;
2212                     return (ASPERR_QUIT);
2213                 default: // command unknown - ignore
2214                     break;
2215             }
2216         }
2217     }
2219     return 0;
2220 } //PAF_ASIT_decodeCommand
2222 // -----------------------------------------------------------------------------
2223 // ASIT Decoding Function - Reinitialization of Decode
2224 //
2225 //   Name:      PAF_ASIT_decodeInit
2226 //   Purpose:   Decoding Function for reinitializing the decoding process.
2227 //   From:      AST Parameter Function -> decodeProcessing
2228 //   Uses:      See code.
2229 //   States:    x
2230 //   Return:    Error number in standard or SIO form (0 on success).
2231 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2232 //              * State information as per parent.
2233 //
2234 Int
2235 PAF_ASIT_decodeInit(
2236     const PAF_ASIT_Params *pP, 
2237     const PAF_ASIT_Patchs *pQ, 
2238     PAF_ASIT_Config *pC, 
2239     Int sourceSelect
2242     PAF_AST_Config *pAstCfg;
2243     PAF_AST_DecOpCircBufCtl *pCbCtl;    /* Decoder output circular buffer control */
2244     Int as;                             /* Audio Stream Number (1, 2, etc.) */
2245     Int z;                              /* decode/encode counter */
2246     Int errno;                          /* error number */
2247     Int zI, zS;
2248     Int zMD;
2249     Int zMI;
2250     ASP_Msg* pAspMsg;                   /* Messaging */
2251     Int argIdx;
2252     Int decErrno;
2253     Int status;
2254     
2255     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
2256     as = pAstCfg->as;
2257     zMD = pAstCfg->masterDec;
2258     zMI = pP->zone.master;
2259     (void)as;  // clear compiler warning in case not used with tracing disabled
2260     
2261     pCbCtl = &pC->pAspmCfg->decOpCircBufCtl; // get pointer to circular buffer control
2263     // reset frameCount
2264     for (z=DECODE1; z < DECODEN; z++)
2265     {
2266         if (pAstCfg->xDec[z].decodeStatus.mode)
2267         {
2268             pAstCfg->xDec[z].decodeStatus.frameCount = 0;
2269         }
2270     }
2272     for (z=DECODE1; z < DECODEN; z++) 
2273     {
2274         zI = pP->inputsFromDecodes[z];
2275         zS = pP->streamsFromDecodes[z];
2276         (void)zS; // clear compiler warning in case not used with tracing disabled
2277         if (pAstCfg->xInp[zI].hRxSio && pAstCfg->xDec[z].decodeStatus.mode) 
2278         {
2279             Uns gear;
2280             Int frameLength;
2281             TRACE_VERBOSE1("AS%d: PAF_ASIT_decodeInit: initializing decode", as+zS);
2283             // write back Dec configuration
2284             Cache_wb(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2285             Cache_wait();
2286             
2287             // FL: send dec activate message to slave
2288             pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize);  /* allocate message */
2289             if (pAspMsg == NULL)
2290             {
2291                 TRACE_TERSE0("MessageQ_alloc() failure.");
2292                 SW_BREAKPOINT; // temporary
2293                 return -1; // temporary
2294             }
2295             MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
2296             pAspMsg->cmd = ASP_SLAVE_DEC_ACTIVATE;                                              /* fill in message payload */
2297             pAspMsg->procId = hAspMsgMaster->masterProcId;
2298             pAspMsg->expectResp = TRUE;
2299             pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
2300             argIdx = 0; // set decIdx (zone index)
2301             *(Int32 *)&pAspMsg->buf[argIdx] = z;
2302             TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2303             TRACE_MSG1("decIdx=%d", pAspMsg->buf[0]);
2304             status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);                       /* send message */
2305             if (status != MessageQ_S_SUCCESS)
2306             {
2307                 SW_BREAKPOINT;
2308             }
2309             // wait for dec activate complete message from slave
2310             status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
2311             if (status != MessageQ_S_SUCCESS)
2312             {
2313                 TRACE_TERSE0("MessageQ_get() failure.");
2314                 SW_BREAKPOINT; // temporary
2315                 return -1; // temporary
2316             }
2317             if ((pAspMsg->procId != hAspMsgMaster->slaveProcId) || 
2318                 (pAspMsg->cmd != ASP_MASTER_DEC_ACTIVATE_DONE) ||
2319                 (pAspMsg->messageId != (hAspMsgMaster->messageId | ((UInt32)1<<31))))
2320             {
2321                 TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2322                 SW_BREAKPOINT; // temporary
2323                 return -1; // temporary
2324             }      
2325             hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
2326             TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2327             // free the message
2328             status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
2329             if (status != MessageQ_S_SUCCESS)
2330             {
2331                 SW_BREAKPOINT;
2332             }
2333             
2334 #if 0 // FL: decoder activate call, slave
2335             if (decAlg[z]->fxns->algActivate)
2336                 decAlg[z]->fxns->algActivate (decAlg[z]);
2337 #endif
2339             // FL: send dec reset message to slave
2340             pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize);  /* allocate message */
2341             if (pAspMsg == NULL)
2342             {
2343                 TRACE_TERSE0("MessageQ_alloc() failure.");
2344                 SW_BREAKPOINT; // temporary
2345                 return -1; // temporary
2346             }
2347             MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
2348             pAspMsg->cmd = ASP_SLAVE_DEC_RESET;                                                 /* fill in message payload */
2349             pAspMsg->procId = hAspMsgMaster->masterProcId;
2350             pAspMsg->expectResp = TRUE;
2351             pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
2352             argIdx = 0; // set decIdx
2353             *(Int32 *)&pAspMsg->buf[argIdx] = z;
2354             TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2355             TRACE_MSG1("decIdx=%d", pAspMsg->buf[0]);
2356             // wait for dec reset complete message from slave
2357             status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message */
2358             if (status != MessageQ_S_SUCCESS)
2359             {
2360                 SW_BREAKPOINT;
2361             }
2362             status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
2363             if (status != MessageQ_S_SUCCESS)
2364             {
2365                 TRACE_TERSE0("MessageQ_get() failure.");
2366                 SW_BREAKPOINT; // temporary
2367                 return -1; // temporary
2368             }
2369             if ((pAspMsg->procId == hAspMsgMaster->slaveProcId) &&
2370                 (pAspMsg->cmd == ASP_MASTER_DEC_RESET_DONE) && 
2371                 (pAspMsg->messageId == (hAspMsgMaster->messageId | ((UInt32)1<<31))))
2372             {
2373                 hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
2374                 TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2375                 TRACE_MSG1("decErrno=%d", pAspMsg->buf[0]);
2377                 argIdx = 0; // get decErrno
2378                 decErrno = *(Int32 *)&pAspMsg->buf[argIdx];
2379                 if (decErrno != 0)
2380                 {
2381                     return decErrno;
2382                 }
2383             }
2384             else
2385             {
2386                 TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2387                 SW_BREAKPOINT; // temporary
2388                 return -1; // temporary
2389             }
2390             // free the message
2391             status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
2392             if (status != MessageQ_S_SUCCESS)
2393             {
2394                 SW_BREAKPOINT;
2395             }
2397             // (***) FL: revisit
2398             // invalidate Dec configuration
2399             Cache_inv(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2400             Cache_wait();                            
2401             
2402 #if 0 // FL: decoder reset call, slave
2403             if (dec->fxns->reset
2404                 && (errno = dec->fxns->reset (dec, NULL,
2405                                               &pC->xDec[z].decodeControl, &pC->xDec[z].decodeStatus)))
2406                 return errno;
2407 #endif
2408             
2409             gear = pAstCfg->xDec[z].decodeStatus.aspGearControl;
2410             pAstCfg->xDec[z].decodeStatus.aspGearStatus = gear < GEARS ? gear : 0;
2411             
2412 #if 0 // FL: change handle to decIdx (zone index)
2413             frameLength = pP->fxns->computeFrameLength(decAlg[z], 
2414                 FRAMELENGTH,
2415                 pC->xDec[z].decodeStatus.bufferRatio);
2416 #endif
2417 #if 0 // (***) FL: revisit. Bypass computeFrameLength().
2418             frameLength = pP->fxns->computeFrameLength(z, 
2419                 FRAMELENGTH, 
2420                 pC->xDec[z].decodeStatus.bufferRatio);
2421 #else
2422             if (sourceSelect == PAF_SOURCE_PCM)
2423             {
2424                 frameLength = 256;
2425             }
2426             else if (sourceSelect == PAF_SOURCE_DDP)
2427             {
2428                 frameLength = 1536;
2429             }
2430             else
2431             {
2432                 frameLength = 256;
2433             }
2434 #endif    
2435             
2436             pAstCfg->xDec[z].decodeControl.frameLength = frameLength;
2437             pAstCfg->xDec[z].decodeInStruct.sampleCount = frameLength;
2438             pAstCfg->xDec[z].decodeControl.sampleRate = PAF_SAMPLERATE_UNKNOWN;
2439             
2440             // (***) FL: revisit. Count samples for DDP.
2441             // Add framework frame length and running sample count to decoder control.
2442             //pC->xDec[z].decodeControl.pafFrameLength = FRAMELENGTH;
2443             //pC->xDec[z].decodeControl.rdSampleCount = 0;
2445             // Initialize decoder output circular buffer for selected source
2446             errno = cbInit(pCbCtl, z, sourceSelect, frameLength, FRAMELENGTH, 0);
2447             if (errno)
2448             {
2449                 SW_BREAKPOINT; // FL: debug
2450                 return errno;
2451             }
2452             // FL: debug
2453             cbLog(pCbCtl, z, 1, "PAF_ASIT_decodeInit:cbInit");
2454             
2455             if (z != zMD) 
2456             {
2457                 if (errno = SIO_idle(pAstCfg->xInp[zI].hRxSio))
2458                 {
2459                     return errno;
2460                 }
2461             }
2463             if (errno = SIO_ctrl(pAstCfg->xInp[zI].hRxSio, PAF_SIO_CONTROL_SET_SOURCESELECT,
2464                 DECSIOMAP(pAstCfg->xDec[z].decodeStatus.sourceSelect)))
2465             {
2466                 return errno;
2467             }
2468             if (errno = SIO_ctrl(pAstCfg->xInp[zI].hRxSio, PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, 
2469                 frameLength))
2470             {
2471                 return errno;
2472             }
2473             if (errno = pP->fxns->updateInputStatus(pAstCfg->xInp[zI].hRxSio, &pAstCfg->xInp[zI].inpBufStatus, 
2474                 &pAstCfg->xInp[zI].inpBufConfig))
2475             {
2476                 return errno;
2477             }
2478         }
2479     }
2481     if (pAstCfg->xInp[zMI].hRxSio) 
2482     {
2483         errno = SIO_issue(pAstCfg->xInp[zMI].hRxSio, &pAstCfg->xInp[zMI].inpBufConfig,
2484             sizeof(pAstCfg->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME);
2485         if (errno)
2486         {
2487             return errno;
2488         }
2489     }
2491     return 0;
2492 } //PAF_AST_decodeInit
2494 // -----------------------------------------------------------------------------
2495 // ASIT Decoding Function - Info Processing, Common
2496 //
2497 //   Name:      PAF_ASIT_decodeInfo
2498 //   Purpose:   Decoding Function for processing information in a manner that
2499 //              is common for both initial and subsequent frames of input data.
2500 //   From:      AST Parameter Function -> decodeProcessing
2501 //   Uses:      See code.
2502 //   States:    x
2503 //   Return:    Error number in standard form (0 on success).
2504 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2505 //              * State information as per parent.
2506 //
2507 Int
2508 PAF_ASIT_decodeInfo(
2509     const PAF_ASIT_Params *pP, 
2510     const PAF_ASIT_Patchs *pQ, 
2511     PAF_ASIT_Config *pC, 
2512     Int frame, 
2513     Int block
2516     PAF_AST_Config *pAstCfg;
2517     Int as;                    /* Audio Stream Number (1, 2, etc.) */
2518     Int z;                     /* input/decode/stream counter */
2519     Int errno;                 /* error number */
2520     Int sioErr;                /* error number, SIO */
2521     Int zD, zI, zS, zX;
2522     Int zMD;
2523     Int zMI;
2524     Int zMS;
2525     UInt32 curTime;
2526     ASP_Msg *pAspMsg;          /* Messaging */
2527     Int argIdx;
2528     Int status;
2529     // FL: revisit
2530     //Int size;
2531     //PAF_InpBufConfig *pIpBufConfig;
2533     pAstCfg = pC->pAstCfg; // get pointer to common (shared) configuration
2534     as = pAstCfg->as;
2535     zMD = pAstCfg->masterDec;
2536     zMS = pAstCfg->masterStr;
2537     zMI = pP->zone.master;
2538     (void)zMS;  (void)as;  // clear compiler warning in case not used with tracing disabled
2539     
2540     // Set decode control: sample rate, emphasis
2541     for (z=INPUT1; z < INPUTN; z++)
2542     {
2543         zD = z;
2544         for (zX = DECODE1; zX < DECODEN; zX++) 
2545         {
2546             if (pP->inputsFromDecodes[zX] == z) 
2547             {
2548                 zD = zX;
2549                 break;
2550             }
2551         }
2553         if (pAstCfg->xInp[z].hRxSio) 
2554         {
2555             //determine associated decoder
2556             if (pAstCfg->xInp[z].inpBufStatus.sampleRateStatus != 
2557                 pAstCfg->xDec[zD].decodeControl.sampleRate) 
2558             {
2559                 if (pAstCfg->xDec[zD].decodeControl.sampleRate == PAF_SAMPLERATE_UNKNOWN) 
2560                 {
2561                     pAstCfg->xDec[zD].decodeControl.sampleRate = 
2562                         pAstCfg->xInp[z].inpBufStatus.sampleRateStatus;
2563                 }
2564                 else
2565                 {
2566                     TRACE_TERSE1("AS%d: return error ASPERR_INFO_RATECHANGE", as+pAstCfg->masterStr);
2567                     TRACE_TERSE2("inpBufStatus.sampleRateStatus: 0x%x, decodeControl.sampleRate: 0x%x",
2568                         pAstCfg->xInp[z].inpBufStatus.sampleRateStatus, 
2569                         pAstCfg->xDec[zD].decodeControl.sampleRate);
2570                     // return (ASPERR_INFO_RATECHANGE);
2571                 }
2572             }
2573             pAstCfg->xDec[zD].decodeControl.emphasis = 
2574                 pAstCfg->xDec[zD].decodeStatus.sourceDecode != PAF_SOURCE_PCM
2575                 ? PAF_IEC_PREEMPHASIS_NO // fix for Mantis ID #119
2576                 : pAstCfg->xInp[z].inpBufStatus.emphasisStatus;
2577         }
2578         else 
2579         {
2580             pAstCfg->xDec[zD].decodeControl.sampleRate = PAF_SAMPLERATE_UNKNOWN;
2581             pAstCfg->xDec[zD].decodeControl.emphasis = PAF_IEC_PREEMPHASIS_UNKNOWN;
2582         }
2583     }
2585     // Wait for info input
2586     TRACE_VERBOSE2("PAF_ASIT_decodeInfo: AS%d: awaiting frame %d -- sync+info+data", as+zMS, frame);
2587     if (pAstCfg->xInp[zMI].hRxSio) 
2588     {
2589         TRACE_VERBOSE0("PAF_ASIT_decodeInfo: call SIO_reclaim to get input buffer.");
2590         sioErr = SIO_reclaim(pAstCfg->xInp[zMI].hRxSio, (Ptr)&pAstCfg->xInp[zMI].pInpBuf, NULL);
2591         if (sioErr != sizeof(pAstCfg->xInp[zMI].inpBufConfig))
2592         {
2593             TRACE_TERSE1("SIO_reclaim on input returned error ASPERR_RECLAIM.  sioErr: 0x%x", sioErr);
2594             return ASPERR_RECLAIM;
2595         }
2596         
2597         // FL: debug, capture input buffer
2598         //capIb(pAstCfg->xInp[zMI].pInpBuf);
2599         
2600         //
2601         // Simulate Rx SIO_reclaim() pend
2602         //
2603         //Semaphore_pend(semaphoreRxAudio, BIOS_WAIT_FOREVER); 
2604         gTaskAsipCnt++;
2605         curTime = Clock_getTicks();
2606         //System_printf("System time in TaskAsipFxn Rx audio = %lu\n", (ULong)curTime);        
2607         //Log_info1("System time in TaskAsipFxn Rx audio = %u", curTime);
2608         //Log_info1("decodeInfo():Rx SIO reclaim(), system time = %u", curTime);
2609     } //pC->xInp[zMI].hRxSio
2611     // Decode info
2612     for (z=DECODE1; z < DECODEN; z++) 
2613     {
2614         zI = pP->inputsFromDecodes[z];
2615         zS = pP->streamsFromDecodes[z];
2616         (void)zS; // clear compiler warning in case not used with tracing disabled
2617         if (pAstCfg->xInp[zI].hRxSio && pAstCfg->xDec[z].decodeStatus.mode) 
2618         {
2619             TRACE_GEN2("PAF_ASIT_decodeInfo: AS%d: processing frame %d -- info", as+zS, frame);
2621             if (errno = pP->fxns->updateInputStatus(pAstCfg->xInp[zI].hRxSio,
2622                 &pAstCfg->xInp[zI].inpBufStatus, &pAstCfg->xInp[zI].inpBufConfig))
2623             {
2624                 TRACE_TERSE1("return error errno 0x%x.", errno);
2625                 return errno;
2626             }
2628 #if 1
2629             // (***) FL: revisit
2630             // write back Inp configuration
2631             Cache_wb(&pAstCfg->xInp[zI], sizeof(PAF_AST_InpBuf), Cache_Type_ALLD, 0);
2632             // write back input data //  (***) GJ: don't need this for 1xI2S HDMI/SPDIF. Maybe need this for 4xI2S HDMI.
2633             //pIpBufConfig = &gPAF_AST_config.xInp[zI].inpBufConfig;
2634             //size = pIpBufConfig->frameLength * pIpBufConfig->sizeofElement;
2635             //Cache_wb((Ptr)pIpBufConfig->pntr.pSmInt, size, Cache_Type_ALLD, 0);
2636             // write back Dec configuration
2637             Cache_wb(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2638             Cache_wait();
2639 #endif
2640             
2641             // FL: send info message to slave
2642             pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize); /* allocate message */
2643             if (pAspMsg == NULL)
2644             {
2645                 TRACE_TERSE0("MessageQ_alloc() failure.");
2646                 SW_BREAKPOINT; // temporary
2647                 return -1;  // temporary
2648             }
2649             MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
2650             pAspMsg->cmd = ASP_SLAVE_DEC_INFO;                                                  /* fill in message payload */
2651             pAspMsg->procId = hAspMsgMaster->masterProcId;
2652             pAspMsg->expectResp = TRUE;
2653             pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
2654             argIdx = 0; // set decIdx
2655             *(Int32 *)&pAspMsg->buf[argIdx] = z;
2656             TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
2657             TRACE_MSG1("decIdx=%d", pAspMsg->buf[0]);
2658             status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message to slave */
2659             if (status != MessageQ_S_SUCCESS)
2660             {
2661                 SW_BREAKPOINT;
2662             }
2663             // wait for dec info complete message from slave -- temporary
2664             status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
2665             if (status != MessageQ_S_SUCCESS)
2666             {
2667                 TRACE_TERSE0("MessageQ_get() failure.");
2668                 SW_BREAKPOINT;
2669               &nb