PASDK-432:Add code to check for null pointer in shared Beta table
[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                                    
360 // For writeDECCommandRestart
361 volatile UInt32 gCommandOutputTask_SYNC   =0;
362 volatile UInt32 gCommandOutputTask_ACK    =0;
364 #include "dbgDib.h" // debug
366 extern struct {
367     Int size;
368     IALG_Status *pStatus[512];
369 } IACP_STD_BETA_TABLE;
371 // FL: debug
372 #include "evmc66x_gpio_dbg.h"
374 /*
375  *  ======== taskAsipFxn ========
376  *  Audio Stream Input Processing task function
377  */
378 Void taskAsipFxn(
379 //    Int betaPrimeValue, // FL: revisit
380     const PAF_ASIT_Params *pP,
381     const PAF_ASIT_Patchs *pQ
384     PAF_ASIT_Config *pAsitCfg;      /* ASIT configuration pointer */
385     PAF_AST_Config *pAstCfg;        /* AST Common (shared) configuration pointer */
386     Int as;                         /* Audio Stream Number (1, 2, etc.) */
387     Int z;                          /* input/encode/stream/decode/output counter */
388     Int i;                          /* phase */
389     Int errno;                      /* error number */
390     Int zMD, zMI, zMS, zX;
391     Int loopCount = 0;  // used to stop trace to see startup behavior.        
392     Int size;
393     // Messaging
394     ASP_Msg *pAspMsg;              
395     Int status;
396     Int8 tempVar8;
397     char asipMsgBuf[ASP_MSG_BUF_LEN];
399     Log_info0("Enter taskAsipFxn()");
401     //
402     // Audio Stream Input Task Parameters & Patch (*pP, *pQ)
403     //
404     if (!pP) 
405     {
406         TRACE_TERSE0("TaskAsip: No Parameters defined. Exiting.");
407         LINNO_RPRT(TaskAsip, -1);
408         return;
409     }
411     if (!pQ)
412     {
413         TRACE_TERSE0("TaskAsip: No Patchs defined. Exiting.");
414         LINNO_RPRT(TaskAsip, -1);
415         return;
416     }    
417     
418     //
419     // Audio Stream Input Task Configuration (*pAsitCfg):
420     //
421     pAsitCfg = &gPAF_ASIT_config;       // initialize pointer to task configuration
422     pAsitCfg->taskHandle = Task_self(); // set task handle
423     pAstCfg = pAsitCfg->pAstCfg;        // get pointer to AST common (shared) configuration
425     /* Set Audio Stream Number (1, 2, etc.) */
426     as = gBetaPrimeValue + 1;
427     pAstCfg->as = as;    
428     TRACE_TERSE1("TaskAsip: Started with AS%d.", as);
430     //
431     // Initialize message log trace and line number reporting
432     //
433     for (z=STREAM1; z < STREAMN; z++)
434     {
435         TRACE_TERSE1("TaskAsip: AS%d: initiated", as+z);
436     }
437     LINNO_RPRT(TaskAsip, -1);
438     
439     //
440     // Determine decoder and stream indices associated with the master input
441     //
442     zMI = pP->zone.master;
443     pAstCfg->masterDec = zMI;
444     pAstCfg->masterStr = zMI;
445     for (zX = DECODE1; zX < DECODEN; zX++)
446     {
447         if (pP->inputsFromDecodes[zX] == zMI)
448         {
449             pAstCfg->masterDec = zX;
450             pAstCfg->masterStr = pP->streamsFromDecodes[zX];
451             break;
452         }
453     }
454     zMD = pAstCfg->masterDec;
455     zMS = pAstCfg->masterStr;
457     // Initialize as per parametrized phases:
458     //
459     //   In standard form these are:
460     //      - Malloc: Memory Allocation
461     //      - Config: Configuration Initialization
462     //      - AcpAlg: ACP Algorithm Initialization and Local Attachment
463     //      - Common: Common Memory Initialization
464     //      - AlgKey: Dec/Enc chain to Array Initialization
465     //      - Device: I/O Device Initialization
466     //      - DecOpCircBuf: Decoder Output Circular Buffer
467     //      - OutIS: Output Init-Sync
468     //
469     LINNO_RPRT(TaskAsip, -2);
470     for (i=0; i < lengthof(pP->fxns->initPhase); i++)
471     {
472         Int linno;
473         if (pP->fxns->initPhase[i])
474         {
475             linno = pP->fxns->initPhase[i](pP, pQ, pAsitCfg);
476             if (linno) 
477             {
478                 LINNO_RPRT(TaskAsip, linno);
479                 return;
480             }
481         }
482         else 
483         {
484             TRACE_TERSE1("TaskAsip: AS%d: initialization phase - null", as+zMS);
485         }
486         TRACE_TERSE2("TaskAsip: AS%d: initialization phase - %d completed", as+zMS, i);
487         LINNO_RPRT(TaskAsip, -i-3);
488     }
490     //
491     // End of Initialization -- display memory usage report.
492     //
493     if (pP->fxns->memStatusPrint)
494     {
495         pP->fxns->memStatusPrint("ASIT MEMSTAT REPORT",
496             HEAP_INTERNAL, HEAP_INTERNAL1, HEAP_EXTERNAL, 
497             HEAP_INTERNAL1_SHM, HEAP_EXTERNAL_SHM, HEAP_EXTERNAL_NONCACHED_SHM);
498     }
499     
500     // (***) FL: revisit
501     // write back AST shared configuration
502     Cache_wb(pAstCfg, sizeof(PAF_AST_Config), Cache_Type_ALLD, 0);
503     Cache_wait();
505     // (***) FL: revisit
506     // write back Dec configuration
507     Cache_wb(&pAstCfg->xDec[0], DECODEN*sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
508     Cache_wait();
510     // (***) FL: revisit
511     // write back entire beta table
512     Cache_wb((Ptr)(&IACP_STD_BETA_TABLE.pStatus[0]), 512*sizeof(IALG_Status *), Cache_Type_ALLD, 0);
513     Cache_wait();
514     
515     // FL: send start initialization message to slave
516     pAspMsg = (ASP_Msg *)MessageQ_alloc(hAspMsgMaster->heapId, hAspMsgMaster->msgSize); /* allocate message */
517     MessageQ_setReplyQueue(hAspMsgMaster->masterQue, (MessageQ_Msg)pAspMsg);            /* set the return address in the message header */
518     pAspMsg->cmd = ASP_SLAVE_START;                                                     /* fill in message payload */
519     pAspMsg->procId = hAspMsgMaster->masterProcId;
520     pAspMsg->messageId = hAspMsgMaster->messageId & ~(1<<31);
521     pAspMsg->expectResp = TRUE;
522     TRACE_MSG3("Tx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
523     status = MessageQ_put(hAspMsgMaster->slaveQue, (MessageQ_Msg)pAspMsg);              /* send message */
524     if (status != MessageQ_S_SUCCESS)
525     {
526         SW_BREAKPOINT;
527     }
528     // wait for initialization complete message from slave
529     do {
530         //status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, MessageQ_FOREVER);
531         status = MessageQ_get(hAspMsgMaster->masterQue, (MessageQ_Msg *)&pAspMsg, 0); // FL: no other thread is allowed to run until Slave finished startup
532     } while ((status != MessageQ_S_SUCCESS) || (pAspMsg->cmd != ASP_MASTER_START_DONE));
533     if ((pAspMsg->procId != hAspMsgMaster->slaveProcId) ||
534         (pAspMsg->cmd != ASP_MASTER_START_DONE) || 
535         (pAspMsg->messageId != (hAspMsgMaster->messageId | ((UInt32)1<<31))))
536     {
537         TRACE_TERSE3("ERROR: Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
538         SW_BREAKPOINT;
539     }
540     hAspMsgMaster->messageId = (hAspMsgMaster->messageId + 1) & ~(1<<31);
541     TRACE_MSG3("Rx ASP message: procId=%d, cmd=%d, messageId=0x%04x", pAspMsg->procId, pAspMsg->cmd, pAspMsg->messageId);
542     status = MessageQ_free((MessageQ_Msg)pAspMsg); /* free the message */
543     if (status != MessageQ_S_SUCCESS)
544     {
545         SW_BREAKPOINT;
546     }
548     // (***) FL: revisit
549     // invalidate Status structure addresses for Beta Units initialized on Slave
550     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
551     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
552     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
553     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
554     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
555     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
556     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
557     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_DTSUHDA]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
558     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
559     Cache_inv((Ptr)(&IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC2]), sizeof(IALG_Status *), Cache_Type_ALLD, 0);
560     Cache_wait();
561     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]) Log_info0("WARNING: beta unit for Dec==NULL");
562     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]) Log_info0("WARNING: beta unit for Dec==NULL");
563     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]) Log_info0("WARNING: beta unit for Dec==NULL");
564     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]) Log_info0("WARNING: beta unit for Dec==NULL");
565     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]) Log_info0("WARNING: beta unit for Dec==NULL");
566     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]) Log_info0("WARNING: beta unit for Dec==NULL");
567     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]) Log_info0("WARNING: beta unit for Dec==NULL");
568     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_DTSUHDA]) Log_info0("WARNING: beta unit for Dec==NULL");
569     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC]) Log_info0("WARNING: beta unit for Dec==NULL");
570     if (!IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC2]) Log_info0("WARNING: beta unit for Dec==NULL");
571     
572     // (***) FL: revisit
573     // invalidate Status structures for Beta Units initialized on Slave
574     //
575     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE] != NULL)
576     {
577         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), sizeof(Int), Cache_Type_ALLD, 0);
578         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]->size;
579         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DECODE]), size, Cache_Type_ALLD, 0);
580         Cache_wait();
581     }
582     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM] != NULL)
583     {
584         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), sizeof(Int), Cache_Type_ALLD, 0);
585         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]->size;
586         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM]), size, Cache_Type_ALLD, 0);
587         Cache_wait();
588     }
589     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2] != NULL)
590     {
591         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]), sizeof(Int), Cache_Type_ALLD, 0);
592         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]->size;
593         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_PCM2]), size, Cache_Type_ALLD, 0);
594         Cache_wait();
595     }
596     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP] != NULL)
597     {
598         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), sizeof(Int), Cache_Type_ALLD, 0);
599         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]->size;
600         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP]), size, Cache_Type_ALLD, 0);
601         Cache_wait();
602     }
603     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2] != NULL)
604     {
605         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]), sizeof(Int), Cache_Type_ALLD, 0);
606         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]->size;
607         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DDP2]), size, Cache_Type_ALLD, 0);
608         Cache_wait();
609     }
610     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD] != NULL)
611     {
612         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]), sizeof(Int), Cache_Type_ALLD, 0);
613         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]->size;
614         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD]), size, Cache_Type_ALLD, 0);
615         Cache_wait();
616     }
617     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2] != NULL)
618     {
619         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]), sizeof(Int), Cache_Type_ALLD, 0);
620         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]->size;
621         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_THD2]), size, Cache_Type_ALLD, 0);
622         Cache_wait();
623     }
624     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_DTSUHDA] != NULL)
625     {
626         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DTSUHDA]), sizeof(Int), Cache_Type_ALLD, 0);
627         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_DTSUHDA]->size;
628         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_DTSUHDA]), size, Cache_Type_ALLD, 0);
629         Cache_wait();
630     }
631     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC] != NULL)
632     {
633         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC]), sizeof(Int), Cache_Type_ALLD, 0);
634         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC]->size;
635         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC]), size, Cache_Type_ALLD, 0);
636         Cache_wait();
637     }
638     if (IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC2] != NULL)
639     {
640         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC2]), sizeof(Int), Cache_Type_ALLD, 0);
641         size = IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC2]->size;
642         Cache_inv((Ptr)(IACP_STD_BETA_TABLE.pStatus[STD_BETA_AAC2]), size, Cache_Type_ALLD, 0);
643         Cache_wait();
644     }
645     
646 #ifdef NON_CACHE_STATUS
647     // Get the shared status structure GateMP handles. Initialized at slave.
648     if (statusOp_Init(GATEMP_INDEX_DEC) == STATUSOP_INIT_FAIL)
649     {
650         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_DEC);
651     }
652     if (statusOp_Init(GATEMP_INDEX_DDP) == STATUSOP_INIT_FAIL)
653     {
654         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_DDP);
655     }
656     if (statusOp_Init(GATEMP_INDEX_PCM) == STATUSOP_INIT_FAIL)
657     {
658         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_PCM);
659     }
660     if (statusOp_Init(GATEMP_INDEX_THD) == STATUSOP_INIT_FAIL)
661     {
662         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_THD);
663     }
664     if (statusOp_Init(GATEMP_INDEX_DTS) == STATUSOP_INIT_FAIL)
665     {
666         Log_info1("TaskAfp: Gate Index %d:Open status GateMP Fail.", GATEMP_INDEX_DTS);
667     }
668 #endif
669     // (***) FL: revisit
670     // invalidate Dec configuration
671     Cache_inv(&gPAF_AST_config.xDec[0], DECODEN*sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
672     Cache_wait();
673     
674     //
675     // Main processing loop
676     //   
677     for (z=STREAM1; z < STREAMN; z++)
678     {
679         TRACE_VERBOSE1("TaskAsip: AS%d: running", as+z);
680     }
682     TRACE_TERSE0("TaskAsip: Entering Main Loop.");
683     
684     errno = 0;
685     for (;;)
686     {
687         Int sourceSelect;
688         XDAS_Int8 sourceProgram;
690         loopCount++;
692 #if 0   // enable and tune to see startup behavior.
693         // this is an alternative to fixed/circular setting in pa.cfg.
694         // If you are searching for a memory allocation failure, disable on first round.
695         // All allocation has already happened.
696         // This is the outer loop.  This loop count goes up when the stream resets.
697         // If the stream is running without problems, this does not increment.
698         // If the stream is repeatedly resetting, this loop count will go up rapidly.
699         if (loopCount > 10)  // see traces for a few of the passes through the main loop.
700         {
701              TRACE_TERSE1("TaskAsip: Trace stopped at loop %d.", loopCount);
702              LOG_disable(&TR_MOD);  // stop tracing
703         }
704 #endif
706         TRACE_GEN2("TaskAsip (begin Main loop %d) (errno 0x%x)", loopCount, errno);
707         TRACE_TIME((&TIME_MOD, "as1_f2... + %d = %d (begin Main loop)", dtime(), TSK_time()));
708         
709         // since not decoding indicate such
710         pP->fxns->sourceDecode(pP, pQ, pAsitCfg, PAF_SOURCE_NONE);
712         // any error forces idling of input
713         if (errno) 
714         {
715             // If gCommandOutputTask_SYNC invoked by writeDECCommandRestart, wait for output task in sync ...
716             if (gCommandOutputTask_SYNC) {
717                 TRACE_VERBOSE1("TaskAsip: writeDECCommandRestart issued ... Wait for ack from output task side (errno=%d)", errno);
718                 // Wait for ack
719                 while (gCommandOutputTask_ACK == 0) {
720                     Task_sleep(1);
721                 }
722                 TRACE_VERBOSE0("TaskAsip: writeDECCommandRestart issued ... Sync-ed! Startover the process");
723                 gCommandOutputTask_ACK = 0;
724                 gCommandOutputTask_SYNC = 0;
725             }
726             
727             for (z=INPUT1; z < INPUTN; z++)
728             {
729                 if (pAstCfg->xInp[z].hRxSio)
730                 {
731                     SIO_idle(pAstCfg->xInp[z].hRxSio);
732                 }
733             }
734         
735             TRACE_TERSE1("TaskAsip: Trace stopped at loop %d.", loopCount);
736             ERRNO_RPRT(TaskAsip, errno);
737         }
738         
739         // Execute a TSK_sleep to ensure that any non-blocking code paths are broken
740         // up to allow lower priority tasks to run. This may seem odd to be at the top
741         // of the state machine but provides for a cleaner flow even though the very
742         // first time we enter we do a sleep which is non-intuitive.
743         TRACE_VERBOSE1("TaskAsip: AS%d: ... sleeping ...", as+zMS);
744         TRACE_TIME((&TIME_MOD, "as1-f2... + %d = %d (begin SLEEP)", dtime(), TSK_time()));
745         Task_sleep(1);
747         TRACE_GEN1("TaskAsip: AS%d: Input device selection ...", as+zMS);
748         errno = pP->fxns->selectDevices(pP, pQ, pAsitCfg);
749         if (errno)
750         {
751             TRACE_TERSE2("TaskAsip: selectDevices returned errno = 0x%04x at line %d. AS%d", errno, as+zMS);
752             continue;
753         }
755         // if no master input selected then we don't know what may be at the input
756         // so set to unknown and skip any remaining processing
757         if (!pAstCfg->xInp[zMI].hRxSio)
758         {
759             sharedMemWriteInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram), 
760                                (Int8)PAF_SOURCE_UNKNOWN, GATEMP_INDEX_DEC);
762             TRACE_VERBOSE1("TaskAsip: AS%d: No input selected...", as+zMS);
763             continue;
764         }
765         
766         // if here then we have a valid input so query its status
767         errno = pP->fxns->updateInputStatus(pAstCfg->xInp[zMI].hRxSio, &pAstCfg->xInp[zMI].inpBufStatus, &pAstCfg->xInp[zMI].inpBufConfig);
768         if (errno)
769         {
770             TRACE_VERBOSE1("TaskAsip: continue as updateInputStatus returns 0x%x", errno);
771             continue;
772         }
774         // If master decoder is not enabled, or the input is unlocked, then do nothing
775         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.mode), 
776                                      GATEMP_INDEX_DEC);
777         if (!tempVar8 || !pAstCfg->xInp[zMI].inpBufStatus.lock)
778         {
779             TRACE_VERBOSE0("TaskAsip: Not locked, continue");
780             continue;
781         }
782         
783         // If no source selected then do nothing
784         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceSelect), 
785                                      GATEMP_INDEX_DEC);
786         if (tempVar8 == PAF_SOURCE_NONE)
787         {
788             sharedMemWriteInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram), 
789                                (Int8)PAF_SOURCE_NONE, GATEMP_INDEX_DEC);
790             TRACE_VERBOSE1("TaskAsip: AS%d: no source selected, continue", as+zMS);
791             continue;
792         }
794         // If we want pass processing then proceed directly
795         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceSelect), 
796                                      GATEMP_INDEX_DEC);
797         if (tempVar8 == PAF_SOURCE_PASS)
798         {
799             TRACE_VERBOSE1("TaskAsip: AS%d: Pass processing ...", as+zMS);
800             sharedMemWriteInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram), 
801                                (Int8)PAF_SOURCE_PASS, GATEMP_INDEX_DEC);
803             pP->fxns->sourceDecode(pP, pQ, pAsitCfg, PAF_SOURCE_PASS);
804             if (pP->fxns->passProcessing)
805             {
806                 errno = pP->fxns->passProcessing(pP, pQ, pAsitCfg, NULL);                
807             }
808             else 
809             {
810                 TRACE_TERSE2("TaskAsip: AS%d: Pass Processing not supported, errno 0x%x", as+zMS, ASPERR_PASS);
811                 errno = ASPERR_PASS;
812             }
813             TRACE_VERBOSE0("TaskAsip: continue");
814             continue;
815         }
817         // .....................................................................
818         // At this point we have an enabled input and want to decode something.
819         // If no decoder selected then do nothing. Need to reset the sourceProgram, since
820         // when no decoder is selected there are no calls to IB
821         //if (errno = pP->fxns->autoProcessing(pP, pQ, pC, pC->xDec[zMD].decodeStatus.sourceSelect, pC->xDec[zMD].decAlg[PAF_SOURCE_PCM]))
822         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceSelect), 
823                                      GATEMP_INDEX_DEC);
824         pfpBegin(PFP_ID_ASIT_1, pAsitCfg->taskHandle);  // PFP begin
825         gNumPfpAsit1++;
826         // (***) FL: re-visit, hard-coded to use FRAMELENGTH (pP->frameLength) inside function
827         errno = pP->fxns->autoProcessing(pP, pQ, pAsitCfg, tempVar8, NULL);
828         pfpEnd(PFP_ID_ASIT_1, PFP_FINISH_MEAS);         // PFP end
829         gNumPfpAsit1--;
831         if (errno)
832         {
833             TRACE_VERBOSE1("TaskAsip: autoProcessing returns 0x%x, continue", errno);
834             continue;
835         }
836         
837         // query for input type
838         errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_SOURCEPROGRAM, (Arg )&sourceProgram);
839         if (errno)
840         {
841             TRACE_TERSE2("TaskAsip: SIO_ctrl returns 0x%x, then 0x%x, continue", errno, ASPERR_AUTO_PROGRAM);
842             errno = ASPERR_AUTO_PROGRAM;
843             continue;
844         }
846         sharedMemWriteInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram), 
847                            sourceProgram, GATEMP_INDEX_DEC);
849         // if input is unclassifiable then do nothing
850         if (sourceProgram == PAF_SOURCE_UNKNOWN)
851         {
852             TRACE_VERBOSE0("TaskAsip: Source program unknown. continue");
853             continue;
854         }
856         // now that we have some input classification, and possibly an outstanding
857         // input frame, we determine whether or not to call decodeProcessing and with
858         // what decAlg.
859         sourceSelect = PAF_SOURCE_NONE;
860         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceSelect), 
861                                      GATEMP_INDEX_DEC);
862         switch (tempVar8)
863         {
864             // If autodetecting, decoding everything, and input is something
865             // (i.e. bitstream or PCM) then decode.
866             case PAF_SOURCE_AUTO:
867                 if (sourceProgram >= PAF_SOURCE_PCM)
868                 {
869                     sourceSelect = sourceProgram;                    
870                 }
871                 break;
873             // If autodetecting, decoding only PCM, and input is PCM then decode.
874             case PAF_SOURCE_PCMAUTO:
875                 if (sourceProgram == PAF_SOURCE_PCM)
876                 {
877                     sourceSelect = sourceProgram;                    
878                 }
879                 break;
881             // If autodetecting, decoding only bitstreams, and input is a bitstream then decode.
882             case PAF_SOURCE_BITSTREAM:
883                 if (sourceProgram >= PAF_SOURCE_AC3)
884                 {
885                     sourceSelect = sourceProgram;                    
886                 }
887                 break;
889             // If autodetecting, decoding only DTS, and input is DTS then decode.
890             case PAF_SOURCE_DTSALL:
891                 switch (sourceProgram) 
892                 {
893                     case PAF_SOURCE_DTS11:
894                     case PAF_SOURCE_DTS12:
895                     case PAF_SOURCE_DTS13:
896                     case PAF_SOURCE_DTS14:
897                     case PAF_SOURCE_DTS16:
898                     case PAF_SOURCE_DTSHD:
899                         sourceSelect = sourceProgram;
900                         break;
901                 }
902                 break;
904             // All others, e.g., force modes, fall through to here.
905             // If user made specific selection then program must match select.
906             // (NB: this compare relies on ordering of PAF_SOURCE)
907             default:
908                 sourceSelect = (Int)sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceSelect),
909                                                               GATEMP_INDEX_DEC);
910                 if ((sourceSelect >= PAF_SOURCE_PCM) && (sourceSelect <= PAF_SOURCE_N))
911                 {
912                     if (sourceProgram != sourceSelect)
913                     {
914                         sourceSelect = PAF_SOURCE_NONE;                        
915                     }
916                 }
917                 break;
918         }
920         // if we didn't find any matches then skip
921         if (sourceSelect == PAF_SOURCE_NONE)
922         {
923             TRACE_VERBOSE0("TaskAsip: no matching source type, continue");
924             continue;
925         }
927 #if 0 // debug, reset IB capture buffer
928         capIbReset();
929         gCapIbReset_cnt++;
930         Log_info0("capIbReset()");
931 #endif
933         // send source select message to slave
934         *(Int32 *)&asipMsgBuf[0] = sourceSelect;
935         if(AspMsgSend(ASP_SLAVE_DEC_SOURCE_SELECT, ASP_MASTER_DEC_SOURCE_SELECT_DONE,
936                       asipMsgBuf, NULL) != ASP_MSG_NO_ERR)
937         {
938             TRACE_VERBOSE0("TaskAsip: error in sending SOURCE_SELECT message");
939             SW_BREAKPOINT;
940         }
941         
942         // set to unknown so that we can ensure, for IOS purposes, that sourceDecode = NONE
943         // iff we are in this top level state machine and specifically not in decodeProcessing
944         pP->fxns->sourceDecode(pP, pQ, pAsitCfg, PAF_SOURCE_UNKNOWN);
945         
946         TRACE_VERBOSE1(procName[sourceProgram], as+zMS);
948         // Reduce priority level since autodetection complete
949         Task_setPri(pAsitCfg->taskHandle, Task_getPri(pAsitCfg->taskHandle)-1);
950         
951         gAspProfileEnable=1; // enable ASP profiling
952         
953         TRACE_VERBOSE0("TaskAsip: calling decodeProcessing.");
954         errno = pP->fxns->decodeProcessing(pP, pQ, pAsitCfg, sourceSelect);
955         if (errno) 
956         {
957             TRACE_TERSE1("TaskAsip: decodeProcessing returns 0x%x, continue", errno);
958         }
959         else
960         {
961             TRACE_VERBOSE0("TaskAsip: decodeProcessing complete with no error.");
962         }        
964         gAspProfileEnable=0; // disable ASP profiling
965         
966         // Increase priority level since decoding complete
967         Task_setPri(pAsitCfg->taskHandle, Task_getPri(pAsitCfg->taskHandle)+1);
969         // FL: send dec exit message to slave
970         if( AspMsgSend(ASP_SLAVE_DEC_EXIT, ASP_MASTER_DEC_EXIT_DONE, NULL, NULL)
971             != ASP_MSG_NO_ERR)
972         {
973             TRACE_VERBOSE0("TaskAsip: error in sending DEC_EXIT message");
974             SW_BREAKPOINT;                
975         }
977     } // End of main processing loop for (;;)
978     
979     //Log_info0("Exit taskAsipFxn()");
982 // -----------------------------------------------------------------------------
983 // ASIT Initialization Function - Memory Allocation
984 //
985 //   Name:      PAF_ASIT_initPhaseMalloc
986 //   Purpose:   Audio Stream Input Task Function for initialization of data pointers
987 //              by allocation of memory.
988 //   From:      audioStream1Task or equivalent
989 //   Uses:      See code.
990 //   States:    x
991 //   Return:    0 on success.
992 //              Source code line number on MEM_calloc failure.
993 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
994 //              * State information as per parent.
995 //              * Memory allocation errors.
996 //
997 Int
998 PAF_ASIT_initPhaseMalloc(
999     const PAF_ASIT_Params *pP, 
1000     const PAF_ASIT_Patchs *pQ, 
1001     PAF_ASIT_Config *pAsitCfg
1004     PAF_AST_Config *pAstCfg;
1005     Int as;                    /* Audio Stream Number (1, 2, etc.) */
1006     Int zMS;
1007     Error_Block    eb;
1008         IHeap_Handle   decHeapHandle;
1010     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1011     as = pAstCfg->as;
1012     zMS = pAstCfg->masterStr;
1013     
1014     TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: initialization phase - memory allocation", as+zMS);
1016     // Initialize error block
1017     Error_init(&eb); 
1019     /* Input memory */
1020     if (!(pAstCfg->xInp = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, 
1021         INPUTN * sizeof (*pAstCfg->xInp), 4, &eb)))
1022     {
1023         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
1024         SW_BREAKPOINT;
1025         return __LINE__;
1026     }
1027     TRACE_TERSE3("PAF_ASIT_initPhaseMalloc. (pAstCfg->xInp) %d bytes from space %d at 0x%x.",
1028         INPUTN * sizeof (*pAstCfg->xInp),
1029         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xInp);
1031     /* Decode memory */
1032 #ifdef NON_CACHE_STATUS
1033     decHeapHandle = (IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM;
1034 #else 
1035     decHeapHandle = (IHeap_Handle)HEAP_INTERNAL1_SHM;
1036 #endif
1037     if (!(pAstCfg->xDec = Memory_calloc(decHeapHandle,
1038         DECODEN * sizeof (*pAstCfg->xDec), 4, &eb)))
1039     {
1040         TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: Memory_calloc failed", as+zMS);
1041         SW_BREAKPOINT;
1042         return __LINE__;
1043     }
1045     TRACE_TERSE3("PAF_ASIT_initPhaseMalloc. (pAstCfg->xDec) %d bytes from space %d at 0x%x.",
1046         DECODEN * sizeof (*pAstCfg->xDec),
1047         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xDec);
1048                 
1049     TRACE_TERSE1("PAF_ASIT_initPhaseMalloc: AS%d: initialization phase - memory allocation complete.", as+zMS);
1050     return 0;
1051 } //PAF_ASIT_initPhaseMalloc
1053 // -----------------------------------------------------------------------------
1054 // ASIT Initialization Function - Memory Initialization from Configuration
1055 //
1056 //   Name:      PAF_ASIT_initPhaseConfig
1057 //   Purpose:   Audio Stream Task Function for initialization of data values
1058 //              from parameters.
1059 //   From:      audioStream1Task or equivalent
1060 //   Uses:      See code.
1061 //   States:    x
1062 //   Return:    0 on success.
1063 //              Other as per initFrame0 and initFrame1.
1064 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1065 //              * State information as per parent.
1066 //
1067 Int
1068 PAF_ASIT_initPhaseConfig(
1069     const PAF_ASIT_Params *pP, 
1070     const PAF_ASIT_Patchs *pQ, 
1071     PAF_ASIT_Config *pAsitCfg
1074     PAF_AST_Config *pAstCfg;
1075     Int as;                    /* Audio Stream Number (1, 2, etc.) */
1076     Int z;                     /* input/encode/stream/decode/output counter */
1077     Int zMS;
1079     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1080     as = pAstCfg->as;
1081     zMS = pAstCfg->masterStr;
1082     
1083     TRACE_TERSE1("PAF_ASIT_initPhaseConfig: AS%d: initialization phase - configuration", as+zMS);
1085     //
1086     // Unspecified elements have been initialized to zero during alloc
1087     //
1088     
1089     for (z=INPUT1; z < INPUTN; z++) 
1090     {
1091         pAstCfg->xInp[z].inpBufStatus = *pP->pInpBufStatus;
1092         pAstCfg->xInp[z].inpBufConfig.pBufStatus = &pAstCfg->xInp[z].inpBufStatus;
1093     }
1095     for (z=DECODE1; z < DECODEN; z++) 
1096     {
1097         Int zI = pP->inputsFromDecodes[z];
1098         pAstCfg->xDec[z].decodeControl.size = sizeof(pAstCfg->xDec[z].decodeControl);
1099         pAstCfg->xDec[z].decodeControl.pInpBufConfig = (const PAF_InpBufConfig *)&pAstCfg->xInp[zI].inpBufConfig;
1100         //pC->xDec[z].decodeStatus = *pP->z_pDecodeStatus[z]; // FL: slave
1101     }
1103     TRACE_TERSE1("PAF_ASIT_initPhaseConfig: AS%d: initialization phase - configuration complete.", as+zMS);
1104     return 0;
1105 } //PAF_ASIT_initPhaseConfig
1107 // -----------------------------------------------------------------------------
1108 // ASIT Initialization Function - ACP Algorithm Instantiation
1109 //
1110 //   Name:      PAF_ASIT_initPhaseAcpAlg
1111 //   Purpose:   Audio Stream Input Task Function for initialization of ACP by
1112 //              instantiation of the algorithm.
1113 //   From:      audioStream1Task or equivalent
1114 //   Uses:      See code.
1115 //   States:    x
1116 //   Return:    0 on success.
1117 //              Source code line number on ACP Algorithm creation failure.
1118 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1119 //              * State information as per parent.
1120 //              * Memory allocation errors.
1121 //
1122 Int
1123 PAF_ASIT_initPhaseAcpAlg(
1124     const PAF_ASIT_Params *pP, 
1125     const PAF_ASIT_Patchs *pQ, 
1126     PAF_ASIT_Config *pAsitCfg
1129     PAF_AST_Config *pAstCfg;
1130     Int as;                 /* Audio Stream Number (1, 2, etc.) */
1131     Int z;                  /* input/encode/stream/decode/output counter */
1132     Int betaPrimeOffset;
1133     ACP_Handle acp;
1134     Int zMS;
1135     Int zS, zX;
1137     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1138     as = pAstCfg->as;
1139     zMS = pAstCfg->masterStr;
1140     
1141     TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: initialization phase - ACP Algorithm", as+zMS);
1143     ACP_MDS_init();
1145     if (!(acp = (ACP_Handle)ACP_MDS_create(NULL))) 
1146     {
1147         TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: ACP algorithm instance creation failed", as+zMS);
1148         return __LINE__;
1149     }
1150     pAsitCfg->acp = acp;
1152     ((ALG_Handle)acp)->fxns->algControl((ALG_Handle) acp,
1153         ACP_GETBETAPRIMEOFFSET, (IALG_Status *)&betaPrimeOffset);
1155     for (z=INPUT1; z < INPUTN; z++) 
1156     {
1157         zS = z;
1158         for (zX = DECODE1; zX < DECODEN; zX++) 
1159         {
1160             if (pP->inputsFromDecodes[zX] == z) 
1161             {
1162                 zS = pP->streamsFromDecodes[zX];
1163                 break;
1164             }
1165         }
1166         acp->fxns->attach(acp, ACP_SERIES_STD,
1167             STD_BETA_IB + betaPrimeOffset * (as-1+zS),
1168             (IALG_Status *)&pAstCfg->xInp[z].inpBufStatus);
1169         /* Ignore errors, not reported. */
1170     }
1172     TRACE_TERSE1("PAF_ASIT_initPhaseAcpAlg: AS%d: initialization phase - ACP Algorithm complete.", as+zMS);
1174     return 0;
1175 } //PAF_ASIT_initPhaseAcpAlg
1177 // -----------------------------------------------------------------------------
1178 // ASIT Initialization Function - Common Memory
1179 //
1180 //   Name:      PAF_ASIT_initPhaseCommon
1181 //   Purpose:   Audio Stream Input Task Function for allocation of common memory.
1182 //   From:      audioStream1Task or equivalent
1183 //   Uses:      See code.
1184 //   States:    x
1185 //   Return:    0 on success.
1186 //              Source code line number on PAF_ALG_alloc failure.
1187 //              Source code line number on PAF_ALG_mallocMemory failure.
1188 //              Source code line number on Decode Chain initialization failure.
1189 //              Source code line number on ASP Chain initialization failure.
1190 //              Source code line number on Encode Chain initialization failure.
1191 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1192 //              * State information as per parent.
1193 //              * Memory allocation errors.
1194 //
1195 Int
1196 PAF_ASIT_initPhaseCommon(
1197     const PAF_ASIT_Params *pP, 
1198     const PAF_ASIT_Patchs *pQ, 
1199     PAF_ASIT_Config *pAsitCfg
1202     PAF_AST_Config *pAstCfg;
1203     Int as;                     /* Audio Stream Number (1, 2, etc.) */
1204     Int z;                      /* stream counter */
1205     ACP_Handle acp;
1206     PAF_IALG_Config pafAlgConfig;
1207     IALG_MemRec common[3][PAF_IALG_COMMON_MEMN+1];
1208    
1209     acp = pAsitCfg->acp;
1210     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1211     as = pAstCfg->as;
1212     
1213     TRACE_TERSE0("PAF_ASIT_initPhaseCommon: initialization phase - Common Memory");
1215     //
1216     // Determine memory needs and instantiate algorithms across audio streams
1217     //
1218     TRACE_TERSE0("PAF_ASIT_initPhaseCommon: calling PAF_ALG_setup.");
1219     PAF_ALG_setup(&pafAlgConfig, 
1220         HEAP_ID_INTERNAL,               HEAP_INTERNAL, 
1221         HEAP_ID_INTERNAL1,              HEAP_INTERNAL1, 
1222         HEAP_ID_EXTERNAL,               HEAP_EXTERNAL, 
1223         HEAP_ID_INTERNAL1_SHM,          HEAP_INTERNAL1_SHM, 
1224         HEAP_ID_EXTERNAL_SHM,           HEAP_EXTERNAL_SHM, 
1225         HEAP_ID_EXTERNAL_NONCACHED_SHM, HEAP_EXTERNAL_NONCACHED_SHM,
1226         HEAP_CLEAR);
1228     if (pP->fxns->headerPrint)
1229     {
1230         pP->fxns->headerPrint();        
1231     }
1233     for (z = STREAM1; z < STREAMN; z++) 
1234     {
1235         TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: initialization phase - Common Memory", as+z);
1237         //
1238         // Determine common memory for:
1239         //  (1) Logical Input drivers
1240         //
1241         // Decode Algorithms common memory determined in ASP Slave.
1242         //
1243         PAF_ALG_init(common[z], lengthof(common[z]), COMMONSPACE);
1245         //
1246         // Determine common memory needs of Logical Input driver
1247         //
1249         // really need to loop over all inputs for this stream using the tables
1250         // inputsFromDecodes and streamsFromDecodes. But these don't exist for this
1251         // patch, and not needed for FS11, since there is only one input.
1252         if (INPUT1 <= z && z < INPUTN) 
1253         {
1254             TRACE_TERSE2("PAF_ASIT_initPhaseCommon: AS%d: alloc inpLinkInit common[%d]", as+z, z);
1255             if (PAF_ALG_ALLOC(inpLinkInit[z-INPUT1], common[z]))
1256             {
1257                 TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: PAF_ALG_alloc failed", as+z);
1258                 TRACE_TERSE2("failed to alloc %d bytes from space %d", common[z]->size, (IArg)common[z]->space);
1259                 SW_BREAKPOINT;
1260                 return __LINE__;
1261             }
1262             TRACE_TERSE3("alloced %d bytes from space %d at 0x%x", common[z]->size, common[z]->space, (IArg)common[z]->base);
1263             if (pP->fxns->allocPrint)
1264             {
1265                 pP->fxns->allocPrint((const PAF_ALG_AllocInit *)(inpLinkInit[z-INPUT1]), sizeof (*(inpLinkInit[z-INPUT1])), &pafAlgConfig);
1266             }
1267         }
1268     }
1269     {
1270         // Changes made to share scratch between zones
1271         // Assume maximum 3 zones and scratch common memory is at offset 0;
1272         int max=0;
1273         for (z=STREAM1; z<STREAMN; z++)
1274         {
1275             if (max < common[z][0].size)
1276             {
1277                 max = common[z][0].size;
1278             }
1279         }
1280         common[STREAM1][0].size=max;
1281         for (z=STREAM1+1; z<STREAMN; z++)
1282         {
1283             common[z][0].size = 0;            
1284         }
1285     }
1286         
1287     //
1288     // Allocate common memory for:
1289     //  (1) Logical Input drivers
1290     //
1291     for (z = STREAM1; z < STREAMN; z++) 
1292     {
1293         TRACE_TERSE0("PAF_ASIT_initPhaseCommon: calling PAF_ALG_mallocMemory for common space.");
1294         if (PAF_ALG_mallocMemory(common[z], &pafAlgConfig)) 
1295         {
1296             TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: PAF_ALG_mallocMemory failed", as+z);
1297             TRACE_TERSE3("AS%d: z: %d.  Size 0x%x", as+z, z, common[z][0].size);
1298             SW_BREAKPOINT;
1299             return __LINE__;
1300         }
1301         TRACE_TERSE3("alloced %d bytes from space %d at 0x%x", common[z]->size, common[z]->space, (IArg)common[z]->base);
1302         // share zone0 scratch with all zones 
1303         common[z][0].base = common[0][0].base;
1304         if (pP->fxns->commonPrint)
1305         {
1306             pP->fxns->commonPrint(common[z], &pafAlgConfig);
1307         }
1309         //
1310         // Allocate non-common memories for Logical IO drivers
1311         //    Since these structures are used at run-time we allocate from external memory
1312         if (INPUT1 <= z && z < INPUTN) 
1313         {
1314             PAF_ASP_Chain *chain;
1315             TRACE_TERSE2("PAF_ASIT_initPhaseCommon: AS%d: non-common input chain init for %d",
1316                            as+z, z);
1317             chain = PAF_ASP_chainInit(&pAstCfg->xInp[z].inpChainData, pP->pChainFxns,
1318                         HEAP_EXTERNAL, as+z, acp, &trace,
1319                         inpLinkInit[z-INPUT1], NULL, common[z], &pafAlgConfig);
1320             if (!chain) 
1321             {
1322                 TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: Input chain initialization failed", as+z);
1323                 return __LINE__;
1324             }
1325         }
1326     }
1327     TRACE_TERSE1("PAF_ASIT_initPhaseCommon: AS%d: Returning complete.", as+z);
1329     return 0;
1330 } //PAF_ASIT_initPhaseCommon
1332 // (***) FL: candidate for removal
1333 // -----------------------------------------------------------------------------
1334 // ASIT Initialization Function - Algorithm Keys
1335 //
1336 //   Name:      PAF_ASIT_initPhaseAlgKey
1337 //   Purpose:   Audio Stream Input Task Function for initialization of data values
1338 //              from parameters for Algorithm Keys.
1339 //   From:      audioStream1Task or equivalent
1340 //   Uses:      See code.
1341 //   States:    x
1342 //   Return:    0.
1343 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1344 //              * State information as per parent.
1345 //
1346 // .............................................................................
1347 Int
1348 PAF_ASIT_initPhaseAlgKey(
1349     const PAF_ASIT_Params *pP, 
1350     const PAF_ASIT_Patchs *pQ, 
1351     PAF_ASIT_Config *pAsitCfg
1354     PAF_AST_Config *pAstCfg;
1355     Int as;                    /* Audio Stream Number (1, 2, etc.) */
1357     
1358     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1359     as = pAstCfg->as;
1360     (void)as;  // clear compiler warning in case not used with tracing disabled
1362     TRACE_VERBOSE1("PAF_ASIT_initPhaseAlgKey: AS%d: initialization phase - Algorithm Keys", as);
1364 #if 0 // FL: slave    
1365     for (z=DECODE1; z < DECODEN; z++) 
1366     {
1367         for (s=0; s < pP->pDecAlgKey->length; s++) 
1368         {
1369             if ((pP->pDecAlgKey->code[s].full != 0) &&
1370                 (that = PAF_ASP_chainFind (&pC->xDec[z].decChainData, pP->pDecAlgKey->code[s]))) 
1371             {
1372                 pC->xDec[z].decAlg[s] = (ALG_Handle )that->alg;
1373                 /* Cast in interface, for now --Kurt */
1374             }
1375             else
1376             {
1377                 pC->xDec[z].decAlg[s] = NULL;
1378             }
1379         }
1380     }
1381 #endif
1383     return 0;
1384 } //PAF_ASIT_initPhaseAlgKey
1386 // -----------------------------------------------------------------------------
1387 // ASIT Initialization Function - I/O Devices
1388 //
1389 //   Name:      PAF_ASIT_initPhaseDevice
1390 //   Purpose:   Audio Stream Input Task Function for initialization of I/O Devices.
1391 //   From:      audioStream1Task or equivalent
1392 //   Uses:      See code.
1393 //   States:    x
1394 //   Return:    0 on success.
1395 //              Source code line number on device allocation failure.
1396 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1397 //              * State information as per parent.
1398 //              * Memory allocation errors.
1399 //
1400 Int
1401 PAF_ASIT_initPhaseDevice(
1402     const PAF_ASIT_Params *pP, 
1403     const PAF_ASIT_Patchs *pQ, 
1404     PAF_ASIT_Config *pAsitCfg
1407     PAF_AST_Config *pAstCfg;
1408     Int as;                             /* Audio Stream Number (1, 2, etc.) */
1409     Int z;                              /* input/output counter */
1410     PAF_SIO_IALG_Obj    *pObj;
1411     PAF_SIO_IALG_Config *pAlgConfig;
1412     PAF_IALG_Config pafAlgConfig;
1415     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1416     as = pAstCfg->as;
1417     (void)as; // clear compiler warning in case not used with tracing disabled
1419     TRACE_TERSE1("PAF_ASIT_initPhaseDevice: AS%d: initialization phase - I/O Devices", as);
1421     if (pP->fxns->bufMemPrint)
1422     {
1423         PAF_ALG_setup (&pafAlgConfig, 
1424             HEAP_ID_INTERNAL,               HEAP_INTERNAL, 
1425             HEAP_ID_INTERNAL1,              HEAP_INTERNAL1,
1426             HEAP_ID_EXTERNAL,               HEAP_EXTERNAL,
1427             HEAP_ID_INTERNAL1_SHM,          HEAP_INTERNAL1_SHM,
1428             HEAP_ID_EXTERNAL_SHM,           HEAP_EXTERNAL_SHM,
1429             HEAP_ID_EXTERNAL_NONCACHED_SHM, HEAP_EXTERNAL_NONCACHED_SHM,
1430             HEAP_CLEAR);
1431         TRACE_TERSE2("PAF_ASIT_initPhaseDevice: AS%d: calling PAF_ALG_setup with clear at %d.", as, HEAP_CLEAR);
1432     }
1434     for (z=INPUT1; z < INPUTN; z++) 
1435     {
1436         PAF_InpBufConfig *pConfig = &pAstCfg->xInp[z].inpBufConfig;
1438         pObj = (PAF_SIO_IALG_Obj *)pAstCfg->xInp[z].inpChainData.head->alg;
1439         pAlgConfig = &pObj->config;
1441         pAstCfg->xInp[z].hRxSio = NULL;
1443         pConfig->base.pVoid       = pAlgConfig->pMemRec[0].base;
1444         pConfig->pntr.pVoid       = pAlgConfig->pMemRec[0].base;
1445         pConfig->head.pVoid       = pAlgConfig->pMemRec[0].base;
1446         pConfig->futureHead.pVoid = pAlgConfig->pMemRec[0].base;
1447         pConfig->allocation       = pAlgConfig->pMemRec[0].size;
1448         pConfig->sizeofElement    = 2;
1449         pConfig->precision        = 16;
1451         if (pP->fxns->bufMemPrint)
1452         {
1453             pP->fxns->bufMemPrint(z, pAlgConfig->pMemRec[0].size, PAF_ALG_memSpaceToHeapId(&pafAlgConfig,pAlgConfig->pMemRec[0].space), 0);
1454         }
1455     }
1457     TRACE_TERSE1("PAF_ASIT_initPhaseDevice: AS%d: initialization phase - I/O Devices complete.", as);
1459     return 0;
1460 } //PAF_ASIT_initPhaseDevice
1462 // (***) FL: move to ASOT
1463 // -----------------------------------------------------------------------------
1464 // ASIT Initialization Function - Decoder Output Circular Buffer
1465 //
1466 //   Name:      PAF_ASIT_initPhaseDecOpCircBuf
1467 //   Purpose:   Audio Stream Input Task Function for initialization of Decoder Output Circular Buffer.
1468 //   From:      audioStream1Task or equivalent
1469 //   Uses:      See code.
1470 //   States:    x
1471 //   Return:    0 on success.
1472 //              Source code line number on device allocation failure.
1473 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1474 //              * State information as per parent.
1475 //              * Memory allocation errors.
1476 //
1477 Int
1478 PAF_ASIT_initPhaseDecOpCircBuf(
1479     const PAF_ASIT_Params *pP, 
1480     const PAF_ASIT_Patchs *pQ, 
1481     PAF_ASIT_Config *pAsitCfg
1484     PAF_AST_Config *pAstCfg;
1485     PAF_AST_DecOpCircBuf *pCb;          /* Decoder output circular buffer */
1486     Int as;                             /* Audio Stream Number (1, 2, etc.) */
1487     Int zMS;
1488     Int z;                              /* decode counter */
1489     Int errno;                          /* error number */
1490     Error_Block    eb;
1491     Int i;
1492     ACP_Handle acp;
1493     Int betaPrimeOffset;
1494     Int zS;
1496     // FL: (***)revisit
1497     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1498     as = pAstCfg->as;
1499     zMS = pAstCfg->masterStr;
1501     // Decode output circular buffer memory
1502     if (!(pAstCfg->xDecOpCb = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, 
1503         DECODEN * sizeof (*pAstCfg->xDecOpCb), 4, &eb)))
1504     {
1505         TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1506         SW_BREAKPOINT;
1507         return __LINE__;
1508     }
1510     TRACE_TERSE3("PAF_ASIT_initPhaseDecOpCircBuf. (pAsitCfg->xDecOpCb) %d bytes from space %d at 0x%x.",
1511         DECODEN * sizeof (*pAstCfg->xDecOpCb),
1512         HEAP_ID_INTERNAL1_SHM, (IArg)pAstCfg->xDecOpCb);
1514     for (z=DECODE1; z < DECODEN; z++)
1515     {
1516         pCb = &pAstCfg->xDecOpCb[z];
1517         
1518         // allocate audio frame circular buffer
1519         if (!(pCb->afCb = Memory_calloc((IHeap_Handle)HEAP_INTERNAL1_SHM, ASP_DECOP_CB_MAX_NUM_AF * sizeof(PAF_AudioFrame), 4, &eb)))
1520         {
1521             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1522             SW_BREAKPOINT;
1523         }
1524         // allocate audio frame PCM sample pointer array
1525         for (i = 0; i<ASP_DECOP_CB_MAX_NUM_AF; i++)
1526         {
1527             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)))
1528             {
1529                 TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1530                 SW_BREAKPOINT;
1531             }
1532             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)))
1533             {
1534                 TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1535                 SW_BREAKPOINT;
1536             }                
1537         }
1538         // allocate PCM sample buffer
1539         if (!(pCb->pcmBuf = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_SHM, ASP_DECOP_CB_PCM_BUF_SZ * sizeof(PAF_AudioData), 4, &eb)))
1540         {
1541             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1542             SW_BREAKPOINT;
1543         }
1544         pCb->pcmBufEnd = pCb->pcmBuf + ASP_DECOP_CB_PCM_BUF_SZ;
1545         // allocate Metadata buffers
1546         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)))
1547         {
1548             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1549             SW_BREAKPOINT;
1550         }
1551         pCb->metaBufEnd = pCb->metaBuf + (ASP_DECOP_CB_MAX_NUM_AF * PAF_MAX_PRIVATE_MD_SZ * PAF_MAX_NUM_PRIVATE_MD);
1553         #ifdef CB_RW_OP_CAP_PP // debug
1554         // allocate debug buffer
1555         if (!(pCb->cb_samples_op = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, CB_OP_COUNT_MAX * sizeof(UInt32), 4, &eb)))
1556         {
1557             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1558             SW_BREAKPOINT;
1559         }
1561         // allocate debug buffer
1562         if (!(pCb->cb_op_owner = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, CB_OP_COUNT_MAX * sizeof(UInt8), 4, &eb)))
1563         {
1564             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1565             SW_BREAKPOINT;
1566         }
1568         // allocate debug buffer
1569         if (!(pCb->cb_afRdIdx = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, CB_OP_COUNT_MAX * sizeof(UInt8), 4, &eb)))
1570         {
1571             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1572             SW_BREAKPOINT;
1573         }
1575         // allocate debug buffer
1576         if (!(pCb->cb_afWrtIdx = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, CB_OP_COUNT_MAX * sizeof(UInt8), 4, &eb)))
1577         {
1578             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1579             SW_BREAKPOINT;
1580         }
1582         // allocate debug buffer
1583         if (!(pCb->cb_numAfCb = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, CB_OP_COUNT_MAX * sizeof(UInt8), 4, &eb)))
1584         {
1585             TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: Memory_calloc failed", as+zMS);
1586             SW_BREAKPOINT;
1587         }
1588         #endif
1589     }
1591     for (z = DECODE1; z < DECODEN; z++)
1592     {
1593         //
1594         // Initialize decoder output circular
1595         //
1596         
1597         // Initialize status
1598         pAstCfg->xDecOpCb[z].cbStatus = *pP->z_pDecOpCircBufStatus[z];
1599         
1600         // Default initialization
1601         errno = cbInit(pCb);
1602         if (errno)
1603         {
1604             SW_BREAKPOINT; // FL: debug
1605             return errno;
1606         }
1607     }
1608     
1609     // Get ASIT ACP handle
1610     acp = pAsitCfg->acp;
1611     if (!acp)
1612     {
1613         TRACE_TERSE1("PAF_ASIT_initPhaseDecOpCircBuf: AS%d: ACP algorithm instance creation  failed", as+zMS);
1614         return __LINE__;
1615     }
1616     
1617     // Get Beta Prime offset
1618     ((ALG_Handle)acp)->fxns->algControl((ALG_Handle) acp,
1619         ACP_GETBETAPRIMEOFFSET, (IALG_Status *)&betaPrimeOffset);
1620             
1621     for (z = DECODE1; z < DECODEN; z++)
1622     {
1623         // ACP attach CB
1624         zS = pP->streamsFromDecodes[z];
1625         acp->fxns->attach(acp, ACP_SERIES_STD,
1626             STD_BETA_DECOPCB + betaPrimeOffset * (as-1+zS),
1627             (IALG_Status *)&pAstCfg->xDecOpCb[z].cbStatus);        
1628     }
1629             
1630     return 0;
1631 } //PAF_ASIT_initPhaseDecOpCircBuf
1634 // -----------------------------------------------------------------------------
1635 // ASIT Initialization Function - Output Init-Sync
1636 //
1637 //   Name:      PAF_ASIT_initPhaseOutIS
1638 //   Purpose:   Audio Stream Input Task Function for initialization of Output Init-Sync.
1639 //
1640 Int
1641 PAF_ASIT_initPhaseOutIS(
1642     const PAF_ASIT_Params *pP, 
1643     const PAF_ASIT_Patchs *pQ, 
1644     PAF_ASIT_Config *pAsitCfg
1647     PAF_AST_Config *pAstCfg;
1648     Int as;                             /* Audio Stream Number (1, 2, etc.) */
1649     Int z;                              /* decode counter */
1650     PAF_AST_OutInitSyncInfo *pOutISI;
1651     Error_Block    eb;
1652     Int i;
1655     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1656     as = pAstCfg->as;
1657     
1658     /* Output Init-Sync memory */
1659     if (!(pAstCfg->xOutIsi = Memory_calloc((IHeap_Handle)HEAP_EXTERNAL_NONCACHED_SHM, 
1660         DECODEN * sizeof (*pAstCfg->xOutIsi), 4, &eb)))
1661     {
1662         TRACE_TERSE1("PAF_ASIT_initPhaseOutIS: AS%d: Memory_calloc failed", as);
1663         SW_BREAKPOINT;
1664         return __LINE__;
1665     }
1667     // Reset all decoder stage flags
1668     for (z=DECODE1; z < DECODEN; z++)
1669     {
1670         // Get address of Output Init-Sync Info
1671         pOutISI = &pAstCfg->xOutIsi[z];
1672         for (i = 0; i < ASP_OUTIS_NUM_DEC_STAGES; i++)
1673         {
1674             // Reset flag value
1675             pOutISI->decStageOutInitSyncInfo[i].decFlag = 0;
1676         }
1677     }    
1678     
1679     return 0;
1680 } // PAF_ASIT_initPhaseOutIS
1683 #if 0
1684 // -----------------------------------------------------------------------------
1685 // AST Processing Function - Pass-Through Processing
1686 //
1687 //   Name:      PAF_AST_passProcessing
1688 //   Purpose:   Audio Stream Task Function for processing audio data as a
1689 //              pass-through from the input driver to the output driver
1690 //              for development and testing.
1691 //   From:      audioStream1Task or equivalent
1692 //   Uses:      See code.
1693 //   States:    x
1694 //   Return:    Error number in standard form (0 on success).
1695 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1696 //              * State information on initialization.
1697 //              * State information on processing.
1698 //
1700 #pragma CODE_SECTION(PAF_AST_passProcessing,".text:_PAF_AST_passProcessing")
1701 /* Pass Processing is often omitted from builds to save memory, */
1702 /* and CODE_SECTION/clink constructs facilitate this omission.  */
1704 Int
1705 PAF_AST_passProcessing(const PAF_AST_Params *pP, const PAF_AST_Patchs *pQ, PAF_AST_Config *pC, Int hack)
1707     Int z;                              /* input/output counter */
1708     Int errno = 0;                      /* error number */
1709     Int getVal;
1710     Int rxNumChan, txNumChan;
1711     Int first;
1712     Int zMD = pC->masterDec;
1713     Int zMI = pP->zone.master;
1716 #ifndef __TI_EABI__
1717     asm (" .clink"); /* See comment above regarding CODE_SECTION/clink. */
1718 #endif    
1720     TRACE_VERBOSE0("PAF_AST_passProcessing: initializing");
1722     //
1723     // Determine that receive/transmit channels are compatible
1724     //
1726     // Can handle handle only master input
1727     for (z=INPUT1; z < INPUTN; z++) {
1728         if (z != zMI && pC->xInp[z].hRxSio)
1729             return (ASPERR_PASS + 0x01);
1730     }
1732     /* Number of receive/transmit channels */
1734     if (! pC->xInp[zMI].hRxSio)
1735         return (ASPERR_PASS + 0x11);
1736     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &rxNumChan))
1737         return (ASPERR_PASS + 0x12);
1738     if (rxNumChan > NUM_TX_CHAN(zMI))
1739         return (ASPERR_PASS + 0x13);
1741     for (z=OUTPUT1; z < OUTPUTN; z++) {
1742         if (! pC->xOut[zMI].hTxSio)
1743             return (ASPERR_PASS + 0x10*(z+2) + 0x01);
1744         if (SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &txNumChan))
1745             return (ASPERR_PASS + 0x10*(z+2) + 0x02);
1746         if (txNumChan > NUM_TX_CHAN(zMI))
1747             return (ASPERR_PASS + 0x10*(z+2) + 0x03);
1748     }
1750     //
1751     // Set up receive/transmit
1752     //
1754     SIO_idle (pC->xInp[zMI].hRxSio);
1755     for (z=OUTPUT1; z < OUTPUTN; z++) {
1756         if(SIO_idle (pC->xOut[z].hTxSio))
1757             return ASPERR_IDLE;
1758     }
1760     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_SET_SOURCESELECT, PAF_SOURCE_PCM))
1761         return (ASPERR_PASS + 0x14);
1763     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, FRAMELENGTH))
1764         return (ASPERR_PASS + 0x15);
1766     for (z=OUTPUT1; z < OUTPUTN; z++)
1767         pC->xOut[z].outBufConfig.lengthofFrame = FRAMELENGTH;
1769     if (SIO_issue (pC->xInp[zMI].hRxSio, &pC->xInp[zMI].inpBufConfig, sizeof (pC->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_SYNC))
1770         return ASPERR_PASS + 0x16;
1772     if (SIO_reclaim (pC->xInp[zMI].hRxSio, (Ptr)&pC->xInp[zMI].pInpBuf, NULL) != sizeof (PAF_InpBufConfig))
1773         return ASPERR_PASS + 0x17;
1775     //
1776     // Receive and transmit the data in single-frame buffers
1777     //
1779     first = 1;
1780     while (pC->xDec[zMD].decodeStatus.sourceSelect == PAF_SOURCE_PASS) {
1781         PAF_OutBufConfig *pOutBuf;
1782         PAF_InpBufConfig *pInpBuf;
1784         if (first) {
1785             first = 0;
1787             TRACE_VERBOSE0("PAF_AST_passProcessing: starting output");
1789             for (z=OUTPUT1; z < OUTPUTN; z++) {
1790                 getVal = SIO_issue (pC->xOut[z].hTxSio, &pC->xOut[z].outBufConfig, sizeof(pC->xOut[z].outBufConfig), 0);
1791                 if (getVal > 0) {
1792                     errno = ASPERR_ISSUE;
1793                     break;
1794                 }
1795                 else if (getVal < 0) {
1796                     errno = -getVal;
1797                     break;
1798                 }
1800                 if (getVal = SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_UNMUTE, 0))
1801                     return (getVal & 0xff) | ASPERR_MUTE;
1802             }
1803             if (errno)
1804                 break;
1806         }
1808         getVal = SIO_issue (pC->xInp[zMI].hRxSio, &pC->xInp[zMI].inpBufConfig, sizeof (pC->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME);
1809         if (getVal > 0) {
1810             errno = ASPERR_ISSUE;
1811             break;
1812         }
1814         TRACE_VERBOSE1("PAF_AST_passProcessing: awaiting frame -- input size %d", rxNumChan * FRAMELENGTH);
1816         getVal = SIO_reclaim (pC->xInp[zMI].hRxSio, (Ptr) &pInpBuf, NULL);
1817         if (getVal < 0) {
1818             errno = -getVal;
1819             break;
1820         }
1822         for (z=OUTPUT1; z < OUTPUTN; z++) {
1823             getVal = SIO_reclaim (pC->xOut[z].hTxSio, (Ptr) &pOutBuf, NULL);
1824             if (getVal < 0) {
1825                 errno = -getVal;
1826                 break;
1827             }
1828         }
1829         if( errno )
1830             break;
1832         TRACE_VERBOSE0("PAF_AST_passProcessing: copying frame");
1834         if (errno = pP->fxns->passProcessingCopy (pP, pQ, pC))
1835             break;
1837         for (z=OUTPUT1; z < OUTPUTN; z++) {
1838             getVal = SIO_issue (pC->xOut[z].hTxSio, &pC->xOut[z].outBufConfig, sizeof(pC->xOut[z].outBufConfig), 0);
1839             if (getVal > 0) {
1840                 errno = ASPERR_ISSUE;
1841                 break;
1842             }
1843             else if (getVal < 0) {
1844                 errno = -getVal;
1845                 break;
1846             }
1847         }
1848         if( errno )
1849             break;
1850     }
1852     //
1853     // Close down receive/transmit
1854     //
1856     TRACE_TERSE0("PAF_AST_passProcessing: finalizing"));
1858     for (z=OUTPUT1; z < OUTPUTN; z++) {
1859         if (getVal = SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_MUTE, 0)) {
1860             if (! errno)
1861                 errno = (getVal & 0xff) | ASPERR_MUTE;
1862             /* convert to sensical errno */
1863         }
1864     }
1866     SIO_idle (pC->xInp[zMI].hRxSio);
1867     for (z=OUTPUT1; z < OUTPUTN; z++)
1868         SIO_idle (pC->xOut[z].hTxSio);
1870     return errno;
1872 } //PAF_AST_passProcessing
1873 #endif // #if 0
1875 #if 0
1876 // -----------------------------------------------------------------------------
1877 // AST Processing Function Helper - Pass-Through Processing Patch Point
1878 //
1879 //   Name:      PAF_AST_passProcessingCopy
1880 //   Purpose:   Pass-Through Processing Function for copying audio data
1881 //              from the input buffer to the output buffer.
1882 //   From:      AST Parameter Function -> passProcessing
1883 //   Uses:      See code.
1884 //   States:    x
1885 //   Return:    Error number in standard form (0 on success).
1886 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1887 //              x
1888 //
1890 #pragma CODE_SECTION(PAF_AST_passProcessingCopy,".text:_PAF_AST_passProcessingCopy")
1891 /* Pass Processing is often omitted from builds to save memory, */
1892 /* and CODE_SECTION/clink constructs facilitate this omission.  */
1894 Int
1895 PAF_AST_passProcessingCopy (const PAF_AST_Params *pP, const PAF_AST_Patchs *pQ, PAF_AST_Config *pC)
1897     Int z;                              /* output counter */
1898     Int errno;                          /* error number */
1899     Int i;
1900     Int rxNumChan, txNumChan;
1901     Int zMI = pP->zone.master;
1904     asm (" .clink"); /* See comment above regarding CODE_SECTION/clink. */
1906     // Copy data from input channels to output channels one of two ways:
1908     if (SIO_ctrl (pC->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &rxNumChan))
1909         return (ASPERR_PASS + 0x12);
1911     for (z=OUTPUT1; z < OUTPUTN; z++) {
1912         if (SIO_ctrl (pC->xOut[z].hTxSio, PAF_SIO_CONTROL_GET_NUMCHANNELS, (Arg) &txNumChan))
1913             return (ASPERR_PASS + 0x22);
1915         if( txNumChan <= rxNumChan ) {
1917             // Copy one to one, ignoring later rx channels as needed.
1919             for( i=0; i < txNumChan; i++ ) {
1920                 errno = pP->fxns->copy( i, &pC->xInp[zMI].inpBufConfig, i, &pC->xOut[z].outBufConfig );
1921                 if( errno )
1922                     return errno;
1923             }
1924         }
1925         else {
1927             // Copy one to many, repeating earlier rx channels as needed.
1929             Int from, to;
1931             from = 0;
1932             to   = 0;
1933             while( to < txNumChan ) {
1934                 errno = pP->fxns->copy( from, &pC->xInp[zMI].inpBufConfig, to, &pC->xOut[z].outBufConfig );
1935                 if( errno )
1936                     return errno;
1938                 from++;
1939                 to++;
1940                 if( from == rxNumChan )
1941                     from = 0;
1942             }
1943         }
1944     }
1946     return 0;
1947 } //PAF_AST_passProcessingCopy
1948 #endif // #if 0
1950 // -----------------------------------------------------------------------------
1951 // ASIT Processing Function - Auto Processing
1952 //
1953 //   Name:      PAF_ASIT_autoProcessing
1954 //   Purpose:   Audio Stream Input Task Function for processing audio data to
1955 //              determine the input type without output.
1956 //   From:      audioStream1Task or equivalent
1957 //   Uses:      See code.
1958 //   States:    x
1959 //   Return:    Error number in standard or SIO form (0 on success).
1960 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
1961 //              * State information on initialization.
1962 //
1964 #define DECSIOMAP(X)                                                \
1965     pP->pDecSioMap->map[(X) >= pP->pDecSioMap->length ? 0 : (X)]
1967 Int
1968 PAF_ASIT_autoProcessing(
1969     const PAF_ASIT_Params *pP, 
1970     const PAF_ASIT_Patchs *pQ, 
1971     PAF_ASIT_Config *pAsitCfg, 
1972     Int inputTypeSelect, 
1973     ALG_Handle pcmAlgMaster
1976     PAF_AST_Config *pAstCfg;
1977     Int as;                 /* Audio Stream Number (1, 2, etc.) */
1978     Int errno = 0;          /* error number */
1979     Int nbytes;
1980     Int frameLength;
1981     Int zMD;
1982     Int zMI;
1983     Int zMS;
1984     
1985     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
1986     as = pAstCfg->as;
1987     zMD = pAstCfg->masterDec;
1988     zMS = pAstCfg->masterStr;    
1989     zMI = pP->zone.master;    
1990     
1991     TRACE_VERBOSE1("PAF_ASIT_autoProcessing: AS%d: PAF_AST_autoProcessing", as+zMS);
1993     if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio,
1994                          PAF_SIO_CONTROL_SET_SOURCESELECT,
1995                          DECSIOMAP(pAstCfg->xDec[zMD].decodeStatus.sourceSelect)))
1996     {
1997         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: AS%d: source select returns 0x%x", as+zMS, errno);
1998         return errno;
1999     }
2000     //frameLength = pP->fxns->computeFrameLength (pcmAlgMaster, FRAMELENGTH,
2001     //                                            pC->xDec[zMD].decodeStatus.bufferRatio);
2002     frameLength = FRAMELENGTH; // (***) FL: fix PCM frameLength
2003     
2004     if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio,
2005                          PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, frameLength))
2006     {
2007         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: SET_PCMFRAMELENGTH returns 0x%x, returning ASPERR_AUTO_LENGTH, 0x%x",
2008             errno, ASPERR_AUTO_LENGTH);
2009         return ASPERR_AUTO_LENGTH;
2010     }
2012     if (errno = SIO_issue(pAstCfg->xInp[zMI].hRxSio,
2013                           &pAstCfg->xInp[zMI].inpBufConfig, sizeof(pAstCfg->xInp[zMI].inpBufConfig),
2014                           PAF_SIO_REQUEST_SYNC))
2015     {
2016         TRACE_VERBOSE2("PAF_ASIT_autoProcessing: REQUEST_SYNC returns 0x%x, returning ASPERR_ISSUE, 0x%x",
2017             errno, ASPERR_ISSUE);
2018         return ASPERR_ISSUE;
2019     }
2021     TRACE_VERBOSE1("PAF_ASIT_autoProcessing: AS%d: awaiting sync", as+zMS);
2023     // all of the sync scan work is done in this call. If the error returned
2024     // is DIBERR_SYNC then that just means we didn't find a sync, not a real I/O
2025     // error so we mask it off.
2026     nbytes = SIO_reclaim(pAstCfg->xInp[zMI].hRxSio, (Ptr)&pAstCfg->xInp[zMI].pInpBuf, NULL);
2027     if (nbytes == -DIBERR_SYNC)
2028     {
2029 #if 0 // (***) FL: shows timing of autosync restart
2030         // (***) debug // B5
2031         {
2032             static Uint8 toggleState = 0;
2033             if (toggleState == 0)
2034                 GPIOSetOutput(GPIO_PORT_0, GPIO_PIN_99);
2035             else
2036                 GPIOClearOutput(GPIO_PORT_0, GPIO_PIN_99);
2037             toggleState = ~(toggleState);
2038         }
2039 #endif                
2040         TRACE_TERSE2("PAF_ASIT_autoProcessing: AS%d: SIO_reclaim returned 0x%x, ignoring", as+zMS, nbytes);
2041         return nbytes;
2042     }
2043     if (nbytes != sizeof(PAF_InpBufConfig))
2044     {
2045         TRACE_TERSE3("PAF_ASIT_autoProcessing. SIO_reclaim returned %d, not %d, returning ASPERR_RECLAIM (0x%x)",
2046             nbytes, sizeof(PAF_InpBufConfig), ASPERR_RECLAIM);
2047         return ASPERR_RECLAIM;
2048     }
2049     if (errno)
2050     {
2051         TRACE_TERSE2("PAF_ASIT_autoProcessing: AS%d: returning errno 0x%x", as+zMS, errno);
2052     }
2053     return errno;
2054 } //PAF_ASIT_autoProcessing
2056 UInt32 gProbe1Err=0;
2057 UInt32 gProbe2Err=0;
2058 UInt32 gMajorAuMissed=0;
2060 // -----------------------------------------------------------------------------
2061 // ASIT Processing Function - Decode Processing
2062 //
2063 //   Name:      PAF_ASIT_decodeProcessing
2064 //   Purpose:   Audio Stream Input Task Function for processing audio data.
2065 //   From:      audioStream1Task or equivalent
2066 //   Uses:      See code.
2067 //   States:    x
2068 //   Return:    Error number in standard form (0 on success).
2069 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2070 //              * State information on initialization (via children).
2071 //              * State information on processing (via children).
2072 //              * Decode warnings.
2073 //
2074 // When "writeDECModeContinuous" is used for zMI input/decode:
2075 // PAF_AST_decodeProcessing() loop may be (is designed to be) exited:
2076 // (a) if "writeDECCommandRestart" is used
2077 //    (or "writeDECCommandAbort", but this performs no cleanup whatsoever, and so its use is discouraged)
2078 // (b) if "writeDECSourceSelectNone" is used
2079 // [ the latter events lead to QUIT state, simply for exiting (errme = errno = ASPERR_QUIT)
2080 // (c) if an error occurs in
2081 //     INIT
2082 //     CONT ("subsequent block state", which "Establish[es] secondary timing")
2083 //         -> PAF_AST_decodeCont(): "Await slave inputs"
2084 //     STREAM (errno |= PAF_COMPONENT_ASP)
2085 //     ENCODE (errno |= PAF_COMPONENT_ENCODE)
2086 // [ the latter errors lead to "switch_break:"
2087 //         -> PAF_AST_decodeComplete(), which always returns 0 (no error) ]
2088 //
2089 // [ Notably, in FINAL ("frame-finalization state")
2090 //         -> PAF_AST_decodeFinalTest() is *not* called,
2091 //   and so any other (asynchronous) changes in pC->xDec[zMD].decodeStatus.sourceSelect are ignored. ]
2092 // [ For completeness, note also: "default" state, internal check (errme = errno = ASPERR_UNKNOWNSTATE) ]
2093 //
2094 // States in which error can't occur:
2095 //     AGAIN ("subsequent initial state")
2096 //
2097 // States in which (some) errors must be handled:
2098 //     INFO1 ("first frame state")
2099 //         -> PAF_AST_decodeInfo(): pass on ASPERR_INFO_RATECHANGE, ASPERR_INFO_PROGRAM ("bad" internal error)
2100 //            -> *DONE* must "catch" ASPERR_RECLAIM from SIO_reclaim (pC->xInp[zMI].hRxSio) -- note zMI only **
2101 //               ?*? but what about ASPERR_RESYNC from same call ?*?
2102 //            -> *for now, at least, pass on error from pP->fxns->updateInputStatus ()*
2103 //            -> *DONE* must "catch" error from (zMI) dec->fxns->info() **
2104 //         -> PAF_AST_decodeInfo1(): pass on any errors which occur here:
2105 //            - pP->fxns->streamChainFunction (... PAF_ASP_CHAINFRAMEFXNS_RESET)
2106 //            - enc->fxns->info()
2107 //            - pP->fxns->setCheckRateX()
2108 //            - pP->fxns->startOutput()
2109 //            - "Start slave inputs if necessary"
2110 //     INFO2 ("subsequent frame state")
2111 //         -> PAF_AST_decodeInfo(): (see above)
2112 //         -> PAF_AST_decodeInfo2(): pass on any errors which occur here:
2113 //            - pP->fxns->setCheckRateX()
2114 //     TIME ("timing state")
2115 //         -> PAF_AST_decodeTime(): "Special timing consideations for AC-3"
2116 //         -> performs SIO_issue (... PAF_SIO_REQUEST_FULLFRAME) & SIO_reclaim() *for zMI only*
2117 //         -> now, DIB_issue [PAF_SIO_REQUEST_FULLFRAME] would only return SYS_EINVAL for "bad" internal error
2118 //            (*OK* don't try to recover from this*)
2119 //         -> much more likely would be SIO_reclaim() error (ASPERR_RECLAIM)
2120 //         -> *DONE* must "catch" (just) ASPERR_RECLAIM error -- note zMI only,
2121 //            possibly in PAF_AST_decodeProcessing() itself **
2122 //     DECODE ("decode state")
2123 //         -> PAF_AST_decodeDecode(): pass on error from
2124 //            - PAF_SIO_CONTROL_GET_NUM_REMAINING ("bad" internal error)
2125 //            - dec->fxns->reset()
2126 //            - PAF_SIO_CONTROL_SET_PCMFRAMELENGTH
2127 //         -> *DONE* must catch error from (zMI) dec->fxns->decode()
2128 //         -> *?* must catch ASPERR_ISSUE from (zMI) SIO_issue()
2129 Int
2130 PAF_ASIT_decodeProcessing(
2131     const PAF_ASIT_Params *pP, 
2132     const PAF_ASIT_Patchs *pQ, 
2133     PAF_ASIT_Config *pAsitCfg, 
2134     Int sourceSelect
2137     PAF_AST_Config *pAstCfg;
2138     //Int as = pAsitCfg->as;              /* Audio Stream Number (1, 2, etc.) */
2139     Int z;                              /* decode counter */
2140     Int errno;                          /* error number */
2141     Int getVal;
2142     enum { INIT, INFO1, INFO2, DECODE, FINAL, QUIT } state;
2143     ALG_Handle alg[DECODEN_MAX];
2144     Int zMD;
2145     //Int zMS;
2146     Int frame; // decoder input frame count
2147     Int block; // (***) FL: formerly  -- decoder output block count / input frame
2148     Int8 tempVar8, temp2Var8;
2149     
2150     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
2151     zMD = pAstCfg->masterDec;
2152     //zMS = pAstCfg->masterStr;
2153         
2154     for (z=DECODE1; z < DECODEN; z++)
2155     {
2156         alg[z] = pAstCfg->xDec[z].decAlg[PAF_SOURCE_PCM];        
2157     }
2158     alg[zMD] = NULL; // decAlgMaster; // FL: alg[] init is on slave
2160     //
2161     // Receive and process the data in single-frame buffers
2162     //
2164     state = INIT;
2165     errno = 0; /* error number */
2167     tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceSelect), 
2168                                  GATEMP_INDEX_DEC);
2169     TRACE_TERSE1("PAF_ASIT_decodeProcessing: sourceSelect is %d", tempVar8);
2171     for (;;) 
2172     {
2173         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceSelect), 
2174                                      GATEMP_INDEX_DEC);
2175         if (tempVar8 == PAF_SOURCE_NONE)
2176         {
2177             TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: sourceSelect == PAF_SOURCE_NONE");
2178             state = QUIT;
2179         }
2181         // Process commands (decode)
2182         getVal = pP->fxns->decodeCommand(pP, pQ, pAsitCfg);
2183         if (getVal) 
2184         {
2185             if (state != INIT)   // no need to restart/abort if not yet started
2186             {
2187                 if (getVal == ASPERR_QUIT)
2188                 {
2189                     state = QUIT;
2190                     TRACE_VERBOSE0("PAF_ASIT_decodeProcessing. %d: state = QUIT");
2191                 }
2192                 else if (getVal == ASPERR_ABORT)
2193                 {
2194                     TRACE_VERBOSE0("PAF_ASIT_decodeProcessing. %d: return getVal");
2195                     
2196                     // PFP end -- outside of PFP for errors, EOS, or Input SIO change
2197                     pfpEnd(PFP_ID_ASIT_2, PFP_FINISH_MEAS);
2198                     gNumPfpAsit2--;
2199                     
2200                     return getVal;
2201                 }
2202                 else
2203                 {
2204                     /* ignore */;
2205                 }
2206             }
2207             TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state == INIT");
2208         }
2210         TRACE_TIME((&TIME_MOD,         "... + %d = %d ->", dtime(), TSK_time()));
2211         TRACE_TIME((&TIME_MOD,         "                 state = %s", stateName[state]));
2213         // Process state (decode)
2214         switch (state) 
2215         {
2216             case INIT: // initial state
2217                 gAsipInitCnt++;
2218                 Log_info0("TaskAsip: state=INIT");               
2220                 errno = pP->fxns->decodeInit(pP, pQ, pAsitCfg, sourceSelect);
2221                 if (errno)
2222                 {
2223                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INIT, errno 0x%x.  break after decodeInit", errno);
2224                     break;
2225                 }
2226                                
2227                 frame = 0;
2228                 block = 0;
2230                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INIT->INFO1");
2231                 state = INFO1;
2232                 continue;
2234             case INFO1: // first frame state
2235                 gAsipInfo1Cnt++;
2236                 Log_info0("TaskAsip: state=INFO1");
2237                 
2238                 // Establish primary timing
2239                 errno = pP->fxns->decodeInfo(pP, pQ, pAsitCfg, frame, block);
2240                 if (errno)
2241                 {
2242                     gAsipInfo1_PrimaryErrCnt++;
2243                     TRACE_TERSE1("INFO1: errno 0x%x after decodeInfo, primary timing", errno);
2244                     break;
2245                 }
2246                 
2247                 tempVar8  = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceDecode),
2248                                               GATEMP_INDEX_DEC);
2249                 temp2Var8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.sampleRate), 
2250                                               GATEMP_INDEX_DEC);
2251                 // Don't start decode until major access unit is found.
2252                 if (((tempVar8 == PAF_SOURCE_THD)    ||
2253                      (tempVar8 == PAF_SOURCE_DXP)    ||
2254                      (tempVar8 == PAF_SOURCE_DTSHD)) &&
2255                      (temp2Var8 == PAF_SAMPLERATE_UNKNOWN)) 
2256                 {
2257                     Int z;
2258                     for (z=DECODE1; z < DECODEN; z++) 
2259                     {
2260                         Int zI = pP->inputsFromDecodes[z];
2261                         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.mode), 
2262                                                      GATEMP_INDEX_DEC);
2263                         if (pAstCfg->xInp[zI].hRxSio && tempVar8)
2264                         {
2265                             TRACE_VERBOSE0("TaskAsip: PAF_ASIT_decodeProcessing: INFO1, SIO_issue");
2266                             if (SIO_issue(pAstCfg->xInp[zI].hRxSio, &pAstCfg->xInp[zI].inpBufConfig,
2267                                 sizeof(pAstCfg->xInp[zI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME))
2268                             {
2269                                 gProbe2Err++;
2270                                 TRACE_TERSE0("PAF_ASIT_decodeProcessing. %d: INFO1, return (ASPERR_ISSUE)");
2271                                 
2272                                 // PFP end -- outside of PFP for errors, EOS, or Input SIO change
2273                                 pfpEnd(PFP_ID_ASIT_2, PFP_FINISH_MEAS);
2274                                 gNumPfpAsit2--;
2275                                 
2276                                 return (ASPERR_ISSUE);
2277                             }
2278                         }
2279                     }
2280                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1: frame %d, not major access unit", frame);
2281                     gMajorAuMissed++; // debug
2282                     frame++;
2283                     state = INFO1;
2284                     continue;
2285                 }
2286                 TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1: frame %d, major access unit found", frame);
2288                 // Establish secondary timing
2289                 errno = pP->fxns->decodeInfo1(pP, pQ, pAsitCfg, frame, block);
2290                 if (errno)
2291                 {
2292                     TRACE_VERBOSE1("PAF_ASIT_decodeProcessing: INFO1, errno 0x%x.  break after decodeInfo1", errno);
2293                     gAsipInfo1_ErrCnt++;
2294                     break;
2295                 }
2297                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INFO1->DECODE");
2298                 state = DECODE;
2299                 continue;
2301             case INFO2: // subsequent frame state
2302                 gAsipInfo2Cnt++;
2303                 Log_info0("TaskAsip: state=INFO2");
2305                 // Establish primary timing
2306                 errno = pP->fxns->decodeInfo(pP, pQ, pAsitCfg, frame, block);
2307                 if (errno)
2308                 {
2309                     TRACE_TERSE1("PAF_ASIT_decodeProcessing: INFO2 break on decodeInfo. errno 0x%x", errno);
2310                     gAsipInfo2_PrimaryErrCnt++;
2311                     break;
2312                 }
2313                                 
2314                 // Measure cycles in decode processing loop.
2315                 // Only measures cycles spent in loop.
2316                 pfpEnd(PFP_ID_ASIT_2, PFP_FINISH_MEAS);         // PFP end
2317                 gNumPfpAsit2--;
2318                 pfpBegin(PFP_ID_ASIT_2, pAsitCfg->taskHandle);  // PFP begin
2319                 gNumPfpAsit2++;
2321                 errno = pP->fxns->decodeInfo2(pP, pQ, pAsitCfg, frame, block);
2322                 if (errno)
2323                 {
2324                     TRACE_TERSE1("PAF_ASIT_decodeProcessing. %d: INFO2 break on decodeInfo2. errno 0x%x", errno);
2325                     gAsipInfo2_ErrCnt++;
2326                     break;
2327                 }
2328                
2329                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: INFO2->DECODE");
2330                 state = DECODE;
2331                 continue;
2333             case DECODE: // decode state
2334                 gAsipDecodeCnt++;
2335                 Log_info0("TaskAsip: state=DECODE");
2337                 errno = pP->fxns->decodeDecode(pP, pQ, pAsitCfg, sourceSelect, frame, block);
2338                 if (errno)
2339                 {
2340                     gAsipDecodeErrCnt++;
2341                     TRACE_TERSE1("PAF_ASIT_decodeProcessing: state: DECODE.  decodeDecode err 0x%04x", errno);
2342                     break;
2343                 }
2344                 
2345                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: DECODE->FINAL");
2346                 state = FINAL;
2347                 continue;
2349             case FINAL: // frame-finalization state
2350                 gAsipFinalCnt++;
2351                 Log_info0("TaskAsip: state=FINAL");
2353                 // Check for final frame, and if indicated:
2354                 // - Exit state machine to "complete" processing.
2355                 if (pP->fxns->decodeFinalTest(pP, pQ, pAsitCfg, frame, block)) 
2356                 {
2357                     break;
2358                 }
2360                 frame++;
2361                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: FINAL->AGAIN");
2362                 state = INFO2;
2363                 continue;
2365             case QUIT: // exit state
2366                 gAsipQuitCnt++;
2367                 Log_info0("TaskAsip: state=QUIT");
2369                 // Quit:
2370                 // - Set error number registers.
2371                 // - Exit state machine to "decode complete" processing.
2372                 TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: state: QUIT");
2373                 errno = ASPERR_QUIT;
2374                 break;
2376             default: // unknown state
2378                 // Unknown:
2379                 // - Set error number registers.
2380                 // - Exit state machine to "decode complete" processing.
2382                 TRACE_TERSE1("PAF_ASIT_decodeProcessing: state: unknown, 0x%x", state);
2383                 errno = ASPERR_UNKNOWNSTATE;
2384                 break;
2386         }  // End of switch (state).
2388         TRACE_VERBOSE0("PAF_ASIT_decodeProcessing: Calling decode complete");
2389         if (pP->fxns->decodeComplete(pP, pQ, pAsitCfg, alg, frame, block))
2390         {
2391             /* ignored? */;
2392         }
2393         
2394         TRACE_TIME((&TIME_MOD, "as1-f2: ... + %d = ?? (final? %d)", dtime(), state == FINAL));
2396         // PFP end -- outside of PFP for errors, EOS, or Input SIO change
2397         //pfpEnd(PFP_ID_ASIT_2, PFP_FINISH_MEAS);
2398         //gNumPfpAsit2--;
2399         
2400         //return errno;
2401         break;
2402     }  // End of for (;;) to Receive, process, and transmit the data.
2403     
2404     // PFP end -- outside of PFP for errors, EOS, or Input SIO change
2405     pfpEnd(PFP_ID_ASIT_2, PFP_FINISH_MEAS);
2406     gNumPfpAsit2--;
2407     
2408     return errno;
2409 } //PAF_ASIT_decodeProcessing
2411 // -----------------------------------------------------------------------------
2412 // ASIT Decoding Function - Decode Command Processing
2413 //
2414 //   Name:      PAF_ASIT_decodeCommand
2415 //   Purpose:   Decoding Function for processing Decode Commands.
2416 //   From:      AST Parameter Function -> decodeProcessing
2417 //   Uses:      See code.
2418 //   States:    x
2419 //   Return:    Error number in standard form (0 on success).
2420 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2421 //              * Command execution.
2422 //
2424 Int
2425 PAF_ASIT_decodeCommand(
2426     const PAF_ASIT_Params *pP, 
2427     const PAF_ASIT_Patchs *pQ, 
2428     PAF_ASIT_Config *pAsitCfg
2431     PAF_AST_Config *pAstCfg;
2432     Int as;                 /* Audio Stream Number (1, 2, etc.) */
2433     Int z;                  /* decode counter */
2434     Int zS;
2435     Int8 tempVar8;
2437     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
2438     as = pAstCfg->as;
2440     for (z=DECODE1; z < DECODEN; z++) 
2441     {
2442         zS = pP->streamsFromDecodes[z];
2443         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.command2), 
2444                                      GATEMP_INDEX_DEC);
2445         if (!(tempVar8 & 0x80))
2446         {
2447             switch (tempVar8)
2448             {
2449                 case 0: // command none - process
2450                     tempVar8 |= 0x80;
2451                     sharedMemWriteInt8(&(pAstCfg->xDec[z].decodeStatus.command2),
2452                                        tempVar8, GATEMP_INDEX_DEC);
2453                     break;
2454                 case 1: // command abort - leave now
2455                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command abort (0x%02x)", as+zS, 1);
2456                     tempVar8 |= 0x80;
2457                     sharedMemWriteInt8(&(pAstCfg->xDec[z].decodeStatus.command2),
2458                                        tempVar8, GATEMP_INDEX_DEC);
2459                     return (ASPERR_ABORT);
2460                 case 2: // command restart - leave later
2461                     TRACE_TERSE2("AS%d: PAF_ASIT_decodeCommand: decode command quit (0x%02x)", as+zS, 2);
2462                     tempVar8 |= 0x80;
2463                     sharedMemWriteInt8(&(pAstCfg->xDec[z].decodeStatus.command2),
2464                                        tempVar8, GATEMP_INDEX_DEC);
2465                                        
2466                     // Invoke command to output task to break the loop
2467                     gCommandOutputTask_SYNC = 1;
2468                     
2469                     return (ASPERR_QUIT);
2470                 default: // command unknown - ignore
2471                     break;
2472             }
2473         }
2474     }
2476     return 0;
2477 } //PAF_ASIT_decodeCommand
2479 // -----------------------------------------------------------------------------
2480 // ASIT Decoding Function - Reinitialization of Decode
2481 //
2482 //   Name:      PAF_ASIT_decodeInit
2483 //   Purpose:   Decoding Function for reinitializing the decoding process.
2484 //   From:      AST Parameter Function -> decodeProcessing
2485 //   Uses:      See code.
2486 //   States:    x
2487 //   Return:    Error number in standard or SIO form (0 on success).
2488 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2489 //              * State information as per parent.
2490 //
2491 Int
2492 PAF_ASIT_decodeInit(
2493     const PAF_ASIT_Params *pP, 
2494     const PAF_ASIT_Patchs *pQ, 
2495     PAF_ASIT_Config *pAsitCfg, 
2496     Int sourceSelect
2499     PAF_AST_Config *pAstCfg;
2500     //PAF_AST_DecOpCircBufCtl *pCbCtl;    /* Decoder output circular buffer control */
2501     Int as;                             /* Audio Stream Number (1, 2, etc.) */
2502     Int z;                              /* decode/encode counter */
2503     Int errno;                          /* error number */
2504     Int zI, zS;
2505     Int zMD;
2506     Int zMI;
2507     Int argIdx;
2508     Int8 tempVar8;
2509     char decMsgBuf[ASP_MSG_BUF_LEN];
2510     
2511     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
2512     as = pAstCfg->as;
2513     zMD = pAstCfg->masterDec;
2514     zMI = pP->zone.master;
2515     (void)as;  // clear compiler warning in case not used with tracing disabled
2516     
2517     //pCbCtl = &pAsitCfg->pAspmCfg->decOpCircBufCtl; // get pointer to circular buffer control
2519     // reset frameCount
2520     for (z=DECODE1; z < DECODEN; z++)
2521     {
2522         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.mode),
2523                                      GATEMP_INDEX_DEC);
2524         if (tempVar8)
2525         {
2526             sharedMemWriteInt(&(pAstCfg->xDec[z].decodeStatus.frameCount),
2527                               (Int)0, GATEMP_INDEX_DEC);
2528         }
2529     }
2531     for (z=DECODE1; z < DECODEN; z++) 
2532     {
2533         zI = pP->inputsFromDecodes[z];
2534         zS = pP->streamsFromDecodes[z];
2535         (void)zS; // clear compiler warning in case not used with tracing disabled
2536         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.mode), 
2537                                      GATEMP_INDEX_DEC);
2538         if (pAstCfg->xInp[zI].hRxSio && tempVar8)
2539         {
2541             Uns gear;
2542             Int frameLength;
2543             TRACE_VERBOSE1("AS%d: PAF_ASIT_decodeInit: initializing decode", as+zS);
2545             // write back Dec configuration
2546             Cache_wb(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2547             Cache_wait();
2549             // FL: send dec activate message to slave
2550             argIdx = 0; // set decIdx (zone index)
2551             *(Int32 *)&decMsgBuf[argIdx] = z;
2552             if(AspMsgSend(ASP_SLAVE_DEC_ACTIVATE, ASP_MASTER_DEC_ACTIVATE_DONE, 
2553                           decMsgBuf, NULL) != ASP_MSG_NO_ERR)
2554             {
2555                 TRACE_TERSE0("decodeInit: error in sending DEC_ACTIVATE message ");
2556                 SW_BREAKPOINT; // temporary
2557                 return -1; // temporary
2558             }           
2560 #if 0 // FL: decoder activate call, slave
2561             if (decAlg[z]->fxns->algActivate)
2562                 decAlg[z]->fxns->algActivate (decAlg[z]);
2563 #endif
2564             // FL: send dec reset message to slave
2565             argIdx = 0; // set decIdx
2566             *(Int32 *)&decMsgBuf[argIdx] = z;
2567             if(AspMsgSend(ASP_SLAVE_DEC_RESET, ASP_MASTER_DEC_RESET_DONE, 
2568                           decMsgBuf, decMsgBuf) != ASP_MSG_NO_ERR)
2569             {
2570                 TRACE_TERSE0("decodeInit: error in sending DEC_RESET message ");
2571                 SW_BREAKPOINT; // temporary
2572                 return -1; // temporary
2573             }
2574             else
2575             {
2576                 argIdx = 0; // get decErrno
2577                 errno = *(Int32 *)&decMsgBuf[argIdx];                
2578             }   
2580             // (***) FL: revisit
2581             // invalidate Dec configuration
2582             Cache_inv(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2583             Cache_wait();
2584             
2585 #if 0 // FL: decoder reset call, slave
2586             if (dec->fxns->reset
2587                 && (errno = dec->fxns->reset (dec, NULL,
2588                                               &pC->xDec[z].decodeControl, &pC->xDec[z].decodeStatus)))
2589                 return errno;
2590 #endif
2591             if (errno != 0)
2592             {
2593                 return errno;
2594             }
2595             
2596             gear = (Uns)sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.aspGearControl),
2597                                               GATEMP_INDEX_DEC);
2598             tempVar8 = gear < GEARS ? gear : 0;
2599             sharedMemWriteInt8(&(pAstCfg->xDec[z].decodeStatus.aspGearStatus),
2600                                    tempVar8, GATEMP_INDEX_DEC);
2601             
2602 #if 0 // FL: change handle to decIdx (zone index)
2603             frameLength = pP->fxns->computeFrameLength(decAlg[z], 
2604                 FRAMELENGTH,
2605                 pC->xDec[z].decodeStatus.bufferRatio);
2606 #endif
2607 #if 0 // (***) FL: revisit. Bypass decoder computeFrameLength() function.
2608             frameLength = pP->fxns->computeFrameLength(z, 
2609                 FRAMELENGTH, 
2610                 pC->xDec[z].decodeStatus.bufferRatio);
2611 #else
2612             // Compute decoder frame length based on source selection
2613             frameLength = getFrameLengthSourceSel(pP, sourceSelect);
2614 #endif    
2615             
2616             pAstCfg->xDec[z].decodeControl.frameLength = frameLength;
2617             pAstCfg->xDec[z].decodeInStruct.sampleCount = frameLength;
2618             pAstCfg->xDec[z].decodeControl.sampleRate = PAF_SAMPLERATE_UNKNOWN;
2619           
2620 #if 0 // FL: Moved to ARM:ASDT:INFO
2621             // Initialize decoder output circular buffer for selected source
2622             errno = cbInitSourceSel(pCbCtl, z, sourceSelect, frameLength, FRAMELENGTH, 0);
2623             if (errno)
2624             {
2625                 SW_BREAKPOINT; // debug
2626                 return errno;
2627             }
2628             // debug
2629             cbLog(pCbCtl, z, 1, "PAF_ASIT_decodeInit:cbInitSourceSel");
2630 #endif
2631             
2632             if (z != zMD) 
2633             {
2634                 if (errno = SIO_idle(pAstCfg->xInp[zI].hRxSio))
2635                 {
2636                     return errno;
2637                 }
2638             }
2640             tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.sourceSelect),
2641                                              GATEMP_INDEX_DEC);
2642             if (errno = SIO_ctrl(pAstCfg->xInp[zI].hRxSio, PAF_SIO_CONTROL_SET_SOURCESELECT,
2643                 DECSIOMAP(tempVar8)))
2644             {
2645                 return errno;
2646             }
2648             if (errno = SIO_ctrl(pAstCfg->xInp[zI].hRxSio, PAF_SIO_CONTROL_SET_PCMFRAMELENGTH, 
2649                 frameLength))
2650             {
2651                 return errno;
2652             }
2653             if (errno = pP->fxns->updateInputStatus(pAstCfg->xInp[zI].hRxSio, &pAstCfg->xInp[zI].inpBufStatus, 
2654                 &pAstCfg->xInp[zI].inpBufConfig))
2655             {
2656                 return errno;
2657             }
2658         }
2659     }
2661     if (pAstCfg->xInp[zMI].hRxSio) 
2662     {
2663         errno = SIO_issue(pAstCfg->xInp[zMI].hRxSio, &pAstCfg->xInp[zMI].inpBufConfig,
2664             sizeof(pAstCfg->xInp[zMI].inpBufConfig), PAF_SIO_REQUEST_NEWFRAME);
2665         if (errno)
2666         {
2667             return errno;
2668         }
2669     }
2671     return 0;
2672 } //PAF_AST_decodeInit
2674 // -----------------------------------------------------------------------------
2675 // ASIT Decoding Function - Info Processing, Common
2676 //
2677 //   Name:      PAF_ASIT_decodeInfo
2678 //   Purpose:   Decoding Function for processing information in a manner that
2679 //              is common for both initial and subsequent frames of input data.
2680 //   From:      AST Parameter Function -> decodeProcessing
2681 //   Uses:      See code.
2682 //   States:    x
2683 //   Return:    Error number in standard form (0 on success).
2684 //   Trace:     Message Log "trace" in Debug Project Configuration reports:
2685 //              * State information as per parent.
2686 //
2687 Int
2688 PAF_ASIT_decodeInfo(
2689     const PAF_ASIT_Params *pP, 
2690     const PAF_ASIT_Patchs *pQ, 
2691     PAF_ASIT_Config *pAsitCfg, 
2692     Int frame, 
2693     Int block
2696     PAF_AST_Config *pAstCfg;
2697     Int as;                    /* Audio Stream Number (1, 2, etc.) */
2698     Int z;                     /* input/decode/stream counter */
2699     Int errno;                 /* error number */
2700     Int sioErr;                /* error number, SIO */
2701     Int zD, zI, zS, zX;
2702     Int zMD;
2703     Int zMI;
2704     Int zMS;
2705     Int argIdx;
2706     Int8 tempVar8;
2707     Int tempVar;
2708     char decMsgBuf[ASP_MSG_BUF_LEN];
2709     // FL: revisit
2710     //Int size;
2711     //PAF_InpBufConfig *pIpBufConfig;
2712     // debug
2713     //UInt32 curTime;
2715     pAstCfg = pAsitCfg->pAstCfg; // get pointer to AST common (shared) configuration
2716     as = pAstCfg->as;
2717     zMD = pAstCfg->masterDec;
2718     zMS = pAstCfg->masterStr;
2719     zMI = pP->zone.master;
2720     (void)zMS;  (void)as;  // clear compiler warning in case not used with tracing disabled
2721     
2722     // Set decode control: sample rate, emphasis
2723     for (z=INPUT1; z < INPUTN; z++)
2724     {
2725         zD = z;
2726         for (zX = DECODE1; zX < DECODEN; zX++) 
2727         {
2728             if (pP->inputsFromDecodes[zX] == z) 
2729             {
2730                 zD = zX;
2731                 break;
2732             }
2733         }
2734 #ifdef PROFILER
2735             // modify for different sampling rate
2736             if (pAstCfg->xInp[z].inpBufStatus.sampleRateStatus == PAF_SAMPLERATE_96000HZ)
2737             {
2738                 start_profiling = 1;
2739             }
2740             else
2741             {
2742                 start_profiling = 0;
2743             }
2744 #endif
2745         if (pAstCfg->xInp[z].hRxSio) 
2746         {
2747             //determine associated decoder
2748             if (pAstCfg->xInp[z].inpBufStatus.sampleRateStatus != 
2749                 pAstCfg->xDec[zD].decodeControl.sampleRate) 
2750             {
2751                 if (pAstCfg->xDec[zD].decodeControl.sampleRate == PAF_SAMPLERATE_UNKNOWN) 
2752                 {
2753                     pAstCfg->xDec[zD].decodeControl.sampleRate = 
2754                         pAstCfg->xInp[z].inpBufStatus.sampleRateStatus;
2755                 }
2756                 else
2757                 {
2758                     TRACE_TERSE1("AS%d: return error ASPERR_INFO_RATECHANGE", as+pAstCfg->masterStr);
2759                     TRACE_TERSE2("inpBufStatus.sampleRateStatus: 0x%x, decodeControl.sampleRate: 0x%x",
2760                         pAstCfg->xInp[z].inpBufStatus.sampleRateStatus, 
2761                         pAstCfg->xDec[zD].decodeControl.sampleRate);
2762                     // return (ASPERR_INFO_RATECHANGE);
2763                 }
2764             }
2766             tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zD].decodeStatus.sourceDecode),
2767                                              GATEMP_INDEX_DEC);
2768             pAstCfg->xDec[zD].decodeControl.emphasis = 
2769                 tempVar8 != PAF_SOURCE_PCM
2770                 ? PAF_IEC_PREEMPHASIS_NO // fix for Mantis ID #119
2771                 : pAstCfg->xInp[z].inpBufStatus.emphasisStatus;
2772         }
2773         else 
2774         {
2775             pAstCfg->xDec[zD].decodeControl.sampleRate = PAF_SAMPLERATE_UNKNOWN;
2776             pAstCfg->xDec[zD].decodeControl.emphasis = PAF_IEC_PREEMPHASIS_UNKNOWN;
2777         }
2778     }
2780     // Wait for info input
2781     TRACE_VERBOSE2("PAF_ASIT_decodeInfo: AS%d: awaiting frame %d -- sync+info+data", as+zMS, frame);
2782     if (pAstCfg->xInp[zMI].hRxSio) 
2783     {
2784         TRACE_VERBOSE0("PAF_ASIT_decodeInfo: call SIO_reclaim to get input buffer.");
2785         sioErr = SIO_reclaim(pAstCfg->xInp[zMI].hRxSio, (Ptr)&pAstCfg->xInp[zMI].pInpBuf, NULL);
2786         if (sioErr != sizeof(pAstCfg->xInp[zMI].inpBufConfig))
2787         {
2788             TRACE_TERSE1("SIO_reclaim on input returned error ASPERR_RECLAIM.  sioErr: 0x%x", sioErr);
2789             return ASPERR_RECLAIM;
2790         }
2791         
2792 #if 0 // debug, capture input buffer
2793         capIb(pAstCfg->xInp[zMI].pInpBuf);
2794         gCapIb_cnt++;
2795 #endif
2796         
2797 #if 0 // (***) FL: shows timing of Input Rx SIO reclaim after decoding has started (autodet complete)
2798         // (***) debug // B5
2799         {
2800             static Uint8 toggleState = 0;
2801             if (toggleState == 0)
2802                 GPIOSetOutput(GPIO_PORT_0, GPIO_PIN_99);
2803             else
2804                 GPIOClearOutput(GPIO_PORT_0, GPIO_PIN_99);
2805             toggleState = ~(toggleState);
2806         }
2807 #endif
2809         //
2810         // Simulate Rx SIO_reclaim() pend
2811         //
2812         //Semaphore_pend(semaphoreRxAudio, BIOS_WAIT_FOREVER); 
2813         //curTime = Clock_getTicks();
2814         //System_printf("System time in TaskAsipFxn Rx audio = %lu\n", (ULong)curTime);        
2815         //Log_info1("System time in TaskAsipFxn Rx audio = %u", curTime);
2816         //Log_info1("decodeInfo():Rx SIO reclaim(), system time = %u", curTime);
2817         
2818         gAsipRxSioReclaimCnt++;
2819     } //pAstCfg->xInp[zMI].hRxSio
2821     // Decode info
2822     for (z=DECODE1; z < DECODEN; z++) 
2823     {
2824         zI = pP->inputsFromDecodes[z];
2825         zS = pP->streamsFromDecodes[z];
2826         (void)zS; // clear compiler warning in case not used with tracing disabled
2828         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.mode),
2829                                      GATEMP_INDEX_DEC);
2830         if (pAstCfg->xInp[zI].hRxSio && tempVar8)
2831         {
2832             TRACE_GEN2("PAF_ASIT_decodeInfo: AS%d: processing frame %d -- info", as+zS, frame);
2834             if (errno = pP->fxns->updateInputStatus(pAstCfg->xInp[zI].hRxSio,
2835                 &pAstCfg->xInp[zI].inpBufStatus, &pAstCfg->xInp[zI].inpBufConfig))
2836             {
2837                 TRACE_TERSE1("return error errno 0x%x.", errno);
2838                 return errno;
2839             }
2841 #if 1
2842             // (***) FL: revisit
2843             // write back Inp configuration
2844             Cache_wb(&pAstCfg->xInp[zI], sizeof(PAF_AST_InpBuf), Cache_Type_ALLD, 0);
2845             // write back Dec configuration
2846             Cache_wb(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2847             Cache_wait();
2848 #endif
2849             
2850             // FL: send info message to slave
2851             argIdx = 0; // set decIdx
2852             *(Int32 *)&decMsgBuf[argIdx] = z;
2853             if(AspMsgSend(ASP_SLAVE_DEC_INFO, ASP_MASTER_DEC_INFO_DONE, 
2854                           decMsgBuf, decMsgBuf) != ASP_MSG_NO_ERR)
2855             {
2856                 TRACE_TERSE0("decodeInfo: error in sending DEC_INFO message ");
2857                 SW_BREAKPOINT; // temporary
2858                 return -1;     // temporary
2859             }
2860             else
2861             {
2862                 argIdx = 0; // get decErrno
2863                 errno = *(Int32 *)&decMsgBuf[argIdx];                
2864             }             
2866 #if 1
2867             // (***) FL: revisit
2868             // invalidate Dec configuration
2869             Cache_inv(&pAstCfg->xDec[z], sizeof(PAF_AST_Decode), Cache_Type_ALLD, 0);
2870             Cache_wait();                            
2871 #endif            
2872             
2873 #if 0 // FL: decoder info call, slave
2874             if (dec->fxns->info
2875                 && (errno = dec->fxns->info (dec, NULL,
2876                                              &pC->xDec[z].decodeControl, &pC->xDec[z].decodeStatus))) 
2877 #endif
2878             if (errno)
2879             {
2880                 TRACE_TERSE1("return error errno 0x%x.", errno);
2881                 return errno;
2882             }
2884             // increment decoded frame count
2885             tempVar = sharedMemReadInt(&(pAstCfg->xDec[z].decodeStatus.frameCount),
2886                                        GATEMP_INDEX_DEC);
2887             tempVar += 1;
2888             sharedMemWriteInt(&(pAstCfg->xDec[z].decodeStatus.frameCount),
2889                               tempVar, GATEMP_INDEX_DEC);
2890         }
2891     } // z=DECODE1 to DECODEN
2893     // query IB for latest sourceProgram (needed if we started decoding due to a force mode)
2894     tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[zMD].decodeStatus.mode),
2895                                  GATEMP_INDEX_DEC);
2896     if (tempVar8)
2897     {
2898         XDAS_Int8 sourceProgram;
2899         if (errno = SIO_ctrl(pAstCfg->xInp[zMI].hRxSio, PAF_SIO_CONTROL_GET_SOURCEPROGRAM,
2900             (Arg)&sourceProgram))
2901         {
2902             TRACE_TERSE1("return error ASPERR_AUTO_PROGRAM. errno 0x%x.", errno);
2903             return ASPERR_AUTO_PROGRAM;
2904         }
2906         sharedMemWriteInt8(&(pAstCfg->xDec[zMD].decodeStatus.sourceProgram),
2907                            sourceProgram, GATEMP_INDEX_DEC);
2908     }
2910     // since now decoding update decode status for all enabled decoders
2911     for (z=DECODE1; z < DECODEN; z++)
2912     {
2913         tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.mode),
2914                                      GATEMP_INDEX_DEC);
2915         if (tempVar8)
2916         {
2917             tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.sourceProgram),
2918                                          GATEMP_INDEX_DEC);
2919             sharedMemWriteInt8(&(pAstCfg->xDec[z].decodeStatus.sourceDecode),
2920                                tempVar8, GATEMP_INDEX_DEC);
2922             tempVar8 = sharedMemReadInt8(&(pAstCfg->xDec[z].decodeStatus.sourceSelect),
2923                                          GATEMP_INDEX_DEC);
2924             if (tempVar8 == PAF_SOURCE_SNG)
2925             {
2926                 tempVar8 = PAF_SOURCE_SNG;
2927                 sharedMemWriteInt8(&(pAstCfg->xDec[z].decodeStatus.sourceDecode),
2928