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