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