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