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