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