Line data Source code
1 : /******************************************************************************************************
2 :
3 : (C) 2022-2025 IVAS codec Public Collaboration with portions copyright Dolby International AB, Ericsson AB,
4 : Fraunhofer-Gesellschaft zur Foerderung der angewandten Forschung e.V., Huawei Technologies Co. LTD.,
5 : Koninklijke Philips N.V., Nippon Telegraph and Telephone Corporation, Nokia Technologies Oy, Orange,
6 : Panasonic Holdings Corporation, Qualcomm Technologies, Inc., VoiceAge Corporation, and other
7 : contributors to this repository. All Rights Reserved.
8 :
9 : This software is protected by copyright law and by international treaties.
10 : The IVAS codec Public Collaboration consisting of Dolby International AB, Ericsson AB,
11 : Fraunhofer-Gesellschaft zur Foerderung der angewandten Forschung e.V., Huawei Technologies Co. LTD.,
12 : Koninklijke Philips N.V., Nippon Telegraph and Telephone Corporation, Nokia Technologies Oy, Orange,
13 : Panasonic Holdings Corporation, Qualcomm Technologies, Inc., VoiceAge Corporation, and other
14 : contributors to this repository retain full ownership rights in their respective contributions in
15 : the software. This notice grants no license of any kind, including but not limited to patent
16 : license, nor is any license granted by implication, estoppel or otherwise.
17 :
18 : Contributors are required to enter into the IVAS codec Public Collaboration agreement before making
19 : contributions.
20 :
21 : This software is provided "AS IS", without any express or implied warranties. The software is in the
22 : development stage. It is intended exclusively for experts who have experience with such software and
23 : solely for the purpose of inspection. All implied warranties of non-infringement, merchantability
24 : and fitness for a particular purpose are hereby disclaimed and excluded.
25 :
26 : Any dispute, controversy or claim arising under or in relation to providing this software shall be
27 : submitted to and settled by the final, binding jurisdiction of the courts of Munich, Germany in
28 : accordance with the laws of the Federal Republic of Germany excluding its conflict of law rules and
29 : the United Nations Convention on Contracts on the International Sales of Goods.
30 :
31 : *******************************************************************************************************/
32 :
33 : #include <stdint.h>
34 : #include "options.h"
35 : #include <math.h>
36 : #include "prot.h"
37 : #include "ivas_prot.h"
38 : #include "ivas_prot_rend.h"
39 : #include "cnst.h"
40 : #include "ivas_cnst.h"
41 : #include "ivas_rom_rend.h"
42 : #include "ivas_rom_dec.h"
43 : #include "ivas_rom_com.h"
44 : #include "ivas_rom_binauralRenderer.h"
45 : #ifdef DEBUGGING
46 : #include "debug.h"
47 : #endif
48 : #include "wmc_auto.h"
49 :
50 :
51 : /*-------------------------------------------------------------------------
52 : * Local constants
53 : *------------------------------------------------------------------------*/
54 :
55 : #define REVERB_INPUT_DOWNMIX_CHANNELS ( 11 )
56 : /* Downmix table for sparse frequency domain reverberator */
57 : const float dmxmtx_table[BINAURAL_CHANNELS][REVERB_INPUT_DOWNMIX_CHANNELS] = {
58 : { 1.0f, 0.0f, 0.70709997f, 1.0f, 0.0f, 1.0f, 0.0f, 1.0f, 0.0f, 1.0f, 0.0f },
59 : { 0.0f, 1.0f, 0.70709997f, 0.0f, 1.0f, 0.0f, 1.0f, 0.0f, 1.0f, 0.0f, 1.0f },
60 : };
61 :
62 : /*-------------------------------------------------------------------------
63 : * ivas_binRenderer_filterModule()
64 : *
65 : *
66 : *-------------------------------------------------------------------------*/
67 :
68 8894861 : static void ivas_binRenderer_filterModule(
69 : float out_Conv_CLDFB_real[BINAURAL_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX], /* o : real part of Binaural signals */
70 : float out_Conv_CLDFB_imag[BINAURAL_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX], /* o : imag part of Binaural signals */
71 : float CLDFB_real[][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX], /* i : real part of LS signals */
72 : float CLDFB_imag[][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX], /* i : imag part of LS signals */
73 : const int16_t numTimeSlots, /* i : number of time slots to process */
74 : BINAURAL_RENDERER_HANDLE hBinRenderer, /* i/o: fastconv binaural renderer handle */
75 : const int16_t pos_idx /* i : pose index */
76 : )
77 : {
78 : int16_t bandIdx, k, chIdx, tapIdx;
79 : float *filterStatesLeftRealPtr, *filterStatesLeftImagPtr;
80 : const float *filterTapsLeftRealPtr, *filterTapsLeftImagPtr, *filterTapsRightRealPtr, *filterTapsRightImagPtr;
81 :
82 414287361 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
83 : {
84 6194343380 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
85 : {
86 5788950880 : filterStatesLeftRealPtr = (float *) &( hBinRenderer->hBinRenConvModule->filterStatesLeftReal[pos_idx][bandIdx][chIdx][0] );
87 5788950880 : filterStatesLeftImagPtr = (float *) &( hBinRenderer->hBinRenConvModule->filterStatesLeftImag[pos_idx][bandIdx][chIdx][0] );
88 :
89 5788950880 : filterTapsLeftRealPtr = hBinRenderer->hBinRenConvModule->filterTapsLeftReal[bandIdx][chIdx];
90 5788950880 : filterTapsLeftImagPtr = hBinRenderer->hBinRenConvModule->filterTapsLeftImag[bandIdx][chIdx];
91 5788950880 : filterTapsRightRealPtr = hBinRenderer->hBinRenConvModule->filterTapsRightReal[bandIdx][chIdx];
92 5788950880 : filterTapsRightImagPtr = hBinRenderer->hBinRenConvModule->filterTapsRightImag[bandIdx][chIdx];
93 :
94 28584640480 : for ( k = 0; k < numTimeSlots; k++ )
95 : {
96 22795689600 : float outRealLeft = 0.0f, outRealRight = 0.0f, outImagLeft = 0.0f, outImagRight = 0.0f;
97 :
98 >21255*10^7 : for ( tapIdx = hBinRenderer->hBinRenConvModule->numTapsArray[bandIdx] - 1; tapIdx > 0; tapIdx-- )
99 : {
100 >18975*10^7 : filterStatesLeftRealPtr[tapIdx] = filterStatesLeftRealPtr[tapIdx - 1];
101 >18975*10^7 : filterStatesLeftImagPtr[tapIdx] = filterStatesLeftImagPtr[tapIdx - 1];
102 :
103 : /* Left Real and Imag */
104 >18975*10^7 : outRealLeft += ( filterStatesLeftRealPtr[tapIdx] * filterTapsLeftRealPtr[tapIdx] ) - ( filterStatesLeftImagPtr[tapIdx] * filterTapsLeftImagPtr[tapIdx] );
105 >18975*10^7 : outImagLeft += ( filterStatesLeftRealPtr[tapIdx] * filterTapsLeftImagPtr[tapIdx] ) + ( filterStatesLeftImagPtr[tapIdx] * filterTapsLeftRealPtr[tapIdx] );
106 :
107 : /* Right Real and Imag*/
108 >18975*10^7 : outRealRight += ( filterStatesLeftRealPtr[tapIdx] * filterTapsRightRealPtr[tapIdx] ) - ( filterStatesLeftImagPtr[tapIdx] * filterTapsRightImagPtr[tapIdx] );
109 >18975*10^7 : outImagRight += ( filterStatesLeftRealPtr[tapIdx] * filterTapsRightImagPtr[tapIdx] ) + ( filterStatesLeftImagPtr[tapIdx] * filterTapsRightRealPtr[tapIdx] );
110 : }
111 :
112 22795689600 : filterStatesLeftRealPtr[0] = CLDFB_real[chIdx][k][bandIdx];
113 22795689600 : filterStatesLeftImagPtr[0] = CLDFB_imag[chIdx][k][bandIdx];
114 :
115 :
116 : /* Left Real and Imag */
117 22795689600 : out_Conv_CLDFB_real[0][k][bandIdx] += outRealLeft + ( filterStatesLeftRealPtr[0] * filterTapsLeftRealPtr[0] ) - ( filterStatesLeftImagPtr[0] * filterTapsLeftImagPtr[0] );
118 22795689600 : out_Conv_CLDFB_imag[0][k][bandIdx] += outImagLeft + ( filterStatesLeftRealPtr[0] * filterTapsLeftImagPtr[0] ) + ( filterStatesLeftImagPtr[0] * filterTapsLeftRealPtr[0] );
119 :
120 : /* Right Real and Imag */
121 22795689600 : out_Conv_CLDFB_real[1][k][bandIdx] += outRealRight + ( filterStatesLeftRealPtr[0] * filterTapsRightRealPtr[0] ) - ( filterStatesLeftImagPtr[0] * filterTapsRightImagPtr[0] );
122 22795689600 : out_Conv_CLDFB_imag[1][k][bandIdx] += outImagRight + ( filterStatesLeftRealPtr[0] * filterTapsRightImagPtr[0] ) + ( filterStatesLeftImagPtr[0] * filterTapsRightRealPtr[0] );
123 : }
124 : }
125 : }
126 :
127 8894861 : return;
128 : }
129 :
130 :
131 : /*-------------------------------------------------------------------------
132 : * ivas_binRenderer_convModuleOpen()
133 : *
134 : * Open convolution module handle of fastconv binaural renderer
135 : *-------------------------------------------------------------------------*/
136 :
137 19018 : static ivas_error ivas_binRenderer_convModuleOpen(
138 : BINAURAL_RENDERER_HANDLE hBinRenderer,
139 : const int16_t renderer_type,
140 : const int16_t isLoudspeaker,
141 : const AUDIO_CONFIG input_config,
142 : const HRTFS_FASTCONV_HANDLE hHrtf,
143 : const int16_t num_poses )
144 : {
145 : int16_t bandIdx, chIdx;
146 : BINRENDERER_CONV_MODULE_HANDLE hBinRenConvModule;
147 : int16_t pos_idx;
148 :
149 : /*-----------------------------------------------------------------*
150 : * prepare library opening
151 : *-----------------------------------------------------------------*/
152 :
153 19018 : if ( ( hBinRenConvModule = (BINRENDERER_CONV_MODULE_HANDLE) malloc( sizeof( BINRENDERER_CONV_MODULE ) ) ) == NULL )
154 : {
155 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
156 : }
157 :
158 19018 : if ( !isLoudspeaker )
159 : {
160 11278 : hBinRenderer->nInChannels = audioCfg2channels( input_config );
161 : }
162 : else
163 : {
164 : /* Note: needs to be revisited if multiple LFE support is required */
165 7740 : hBinRenderer->nInChannels = ( audioCfg2channels( input_config ) - isLoudspeaker );
166 : }
167 :
168 19018 : hBinRenConvModule->numTaps = hHrtf->ntaps;
169 :
170 19018 : if ( renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM )
171 : {
172 : /* Use variable order filtering */
173 4147 : bandIdx = 0;
174 24882 : for ( ; bandIdx < 5; bandIdx++ )
175 : {
176 20735 : hBinRenConvModule->numTapsArray[bandIdx] = hBinRenConvModule->numTaps;
177 : }
178 24882 : for ( ; bandIdx < 10; bandIdx++ )
179 : {
180 20735 : hBinRenConvModule->numTapsArray[bandIdx] = (int16_t) ceilf( 0.6f * hBinRenConvModule->numTaps );
181 : }
182 45617 : for ( ; bandIdx < 20; bandIdx++ )
183 : {
184 41470 : hBinRenConvModule->numTapsArray[bandIdx] = (int16_t) ceilf( 0.5f * hBinRenConvModule->numTaps );
185 : }
186 45617 : for ( ; bandIdx < 30; bandIdx++ )
187 : {
188 41470 : hBinRenConvModule->numTapsArray[bandIdx] = (int16_t) ceilf( 0.4f * hBinRenConvModule->numTaps );
189 : }
190 56687 : for ( ; bandIdx < hBinRenderer->conv_band; bandIdx++ )
191 : {
192 52540 : hBinRenConvModule->numTapsArray[bandIdx] = (int16_t) ceilf( 0.3f * hBinRenConvModule->numTaps );
193 : }
194 : }
195 : else
196 : {
197 : /* Use fixed order filtering */
198 14871 : bandIdx = 0;
199 621031 : for ( ; bandIdx < hBinRenderer->conv_band; bandIdx++ )
200 : {
201 606160 : hBinRenConvModule->numTapsArray[bandIdx] = hBinRenConvModule->numTaps;
202 : }
203 : }
204 :
205 : /* allocate memory for filter states */
206 19018 : if ( ( hBinRenConvModule->filterTapsLeftReal = (float ***) malloc( hBinRenderer->conv_band * sizeof( float ** ) ) ) == NULL )
207 : {
208 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
209 : }
210 :
211 19018 : if ( ( hBinRenConvModule->filterTapsLeftImag = (float ***) malloc( hBinRenderer->conv_band * sizeof( float ** ) ) ) == NULL )
212 : {
213 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
214 : }
215 :
216 19018 : if ( ( hBinRenConvModule->filterTapsRightReal = (float ***) malloc( hBinRenderer->conv_band * sizeof( float ** ) ) ) == NULL )
217 : {
218 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
219 : }
220 :
221 19018 : if ( ( hBinRenConvModule->filterTapsRightImag = (float ***) malloc( hBinRenderer->conv_band * sizeof( float ** ) ) ) == NULL )
222 : {
223 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
224 : }
225 :
226 790638 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
227 : {
228 771620 : if ( ( hBinRenConvModule->filterTapsLeftReal[bandIdx] = (float **) malloc( hBinRenderer->nInChannels * sizeof( float * ) ) ) == NULL )
229 : {
230 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
231 : }
232 :
233 771620 : if ( ( hBinRenConvModule->filterTapsLeftImag[bandIdx] = (float **) malloc( hBinRenderer->nInChannels * sizeof( float * ) ) ) == NULL )
234 : {
235 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
236 : }
237 :
238 771620 : if ( ( hBinRenConvModule->filterTapsRightReal[bandIdx] = (float **) malloc( hBinRenderer->nInChannels * sizeof( float * ) ) ) == NULL )
239 : {
240 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
241 : }
242 :
243 771620 : if ( ( hBinRenConvModule->filterTapsRightImag[bandIdx] = (float **) malloc( hBinRenderer->nInChannels * sizeof( float * ) ) ) == NULL )
244 : {
245 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
246 : }
247 : }
248 :
249 19018 : if ( ( hBinRenConvModule->filterStatesLeftReal = (float ****) malloc( num_poses * sizeof( float *** ) ) ) == NULL )
250 : {
251 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
252 : }
253 :
254 19018 : if ( ( hBinRenConvModule->filterStatesLeftImag = (float ****) malloc( num_poses * sizeof( float *** ) ) ) == NULL )
255 : {
256 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
257 : }
258 :
259 40716 : for ( pos_idx = 0; pos_idx < num_poses; pos_idx++ )
260 : {
261 21698 : if ( ( hBinRenConvModule->filterStatesLeftReal[pos_idx] = (float ***) malloc( hBinRenderer->conv_band * sizeof( float ** ) ) ) == NULL )
262 : {
263 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
264 : }
265 :
266 21698 : if ( ( hBinRenConvModule->filterStatesLeftImag[pos_idx] = (float ***) malloc( hBinRenderer->conv_band * sizeof( float ** ) ) ) == NULL )
267 : {
268 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
269 : }
270 :
271 927318 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
272 : {
273 905620 : if ( ( hBinRenConvModule->filterStatesLeftReal[pos_idx][bandIdx] = (float **) malloc( hBinRenderer->nInChannels * sizeof( float * ) ) ) == NULL )
274 : {
275 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
276 : }
277 :
278 905620 : if ( ( hBinRenConvModule->filterStatesLeftImag[pos_idx][bandIdx] = (float **) malloc( hBinRenderer->nInChannels * sizeof( float * ) ) ) == NULL )
279 : {
280 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
281 : }
282 :
283 12946380 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
284 : {
285 12040760 : if ( ( hBinRenConvModule->filterStatesLeftReal[pos_idx][bandIdx][chIdx] = (float *) malloc( hBinRenConvModule->numTapsArray[bandIdx] * sizeof( float ) ) ) == NULL )
286 : {
287 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
288 : }
289 :
290 12040760 : if ( ( hBinRenConvModule->filterStatesLeftImag[pos_idx][bandIdx][chIdx] = (float *) malloc( hBinRenConvModule->numTapsArray[bandIdx] * sizeof( float ) ) ) == NULL )
291 : {
292 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Convolution Module \n" ) );
293 : }
294 : }
295 : }
296 : }
297 :
298 : /* set memories */
299 790638 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
300 : {
301 10668380 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
302 : {
303 9896760 : int16_t tmp = 0;
304 :
305 9896760 : tmp = chIdx;
306 9896760 : if ( isLoudspeaker )
307 : {
308 2284920 : if ( input_config == IVAS_AUDIO_CONFIG_5_1 )
309 : {
310 747700 : tmp = channelIndex_CICP6[chIdx];
311 : }
312 1537220 : else if ( input_config == IVAS_AUDIO_CONFIG_7_1 )
313 : {
314 27720 : tmp = channelIndex_CICP12[chIdx];
315 : }
316 1509500 : else if ( input_config == IVAS_AUDIO_CONFIG_5_1_2 )
317 : {
318 92260 : tmp = channelIndex_CICP14[chIdx];
319 : }
320 1417240 : else if ( input_config == IVAS_AUDIO_CONFIG_5_1_4 )
321 : {
322 17820 : tmp = channelIndex_CICP16[chIdx];
323 : }
324 1399420 : else if ( input_config == IVAS_AUDIO_CONFIG_7_1_4 )
325 : {
326 1399420 : tmp = channelIndex_CICP19[chIdx];
327 : }
328 : #ifdef DEBUGGING
329 : else
330 : {
331 : return IVAS_ERROR( IVAS_ERR_INTERNAL_FATAL, "Error: Channel configuration not specified!\n\n" );
332 : }
333 : #endif
334 : }
335 :
336 9896760 : hBinRenConvModule->filterTapsLeftReal[bandIdx][chIdx] = hHrtf->leftReal[bandIdx][tmp];
337 9896760 : hBinRenConvModule->filterTapsLeftImag[bandIdx][chIdx] = hHrtf->leftImag[bandIdx][tmp];
338 9896760 : hBinRenConvModule->filterTapsRightReal[bandIdx][chIdx] = hHrtf->rightReal[bandIdx][tmp];
339 9896760 : hBinRenConvModule->filterTapsRightImag[bandIdx][chIdx] = hHrtf->rightImag[bandIdx][tmp];
340 : }
341 : }
342 :
343 40716 : for ( pos_idx = 0; pos_idx < num_poses; pos_idx++ )
344 : {
345 927318 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
346 : {
347 12946380 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
348 : {
349 : /* set the memories to zero */
350 12040760 : set_zero( hBinRenConvModule->filterStatesLeftReal[pos_idx][bandIdx][chIdx], hBinRenConvModule->numTapsArray[bandIdx] );
351 12040760 : set_zero( hBinRenConvModule->filterStatesLeftImag[pos_idx][bandIdx][chIdx], hBinRenConvModule->numTapsArray[bandIdx] );
352 : }
353 : }
354 : }
355 :
356 19018 : hBinRenderer->hBinRenConvModule = hBinRenConvModule;
357 :
358 19018 : return IVAS_ERR_OK;
359 : }
360 :
361 :
362 : /*-------------------------------------------------------------------------*
363 : * ivas_init_binaural_hrtf()
364 : *
365 : * initialize memory for HrtfFastConv structure elements
366 : *-------------------------------------------------------------------------*/
367 :
368 10532 : void ivas_init_binaural_hrtf(
369 : HRTFS_FASTCONV *HrtfFastConv /* i/o: FASTCONV HRTF structure */
370 : )
371 : {
372 : int16_t i;
373 :
374 10532 : HrtfFastConv->leftReal = NULL;
375 10532 : HrtfFastConv->leftImag = NULL;
376 10532 : HrtfFastConv->rightReal = NULL;
377 10532 : HrtfFastConv->rightImag = NULL;
378 10532 : HrtfFastConv->FASTCONV_latency_s = 0x00;
379 :
380 10532 : HrtfFastConv->n_channels = 0;
381 10532 : HrtfFastConv->allocate_init_flag = 0x00;
382 10532 : HrtfFastConv->ntaps = 0;
383 :
384 642452 : for ( i = 0; i < CLDFB_NO_CHANNELS_MAX; i++ )
385 : {
386 631920 : HrtfFastConv->fastconvReverberationEneCorrections[i] = 0x00;
387 631920 : HrtfFastConv->fastconvReverberationEneCorrections[i] = 0x00;
388 : }
389 :
390 10532 : return;
391 : }
392 :
393 :
394 : /*-------------------------------------------------------------------------*
395 : * ivas_alloc_pppMem()
396 : *
397 : * Allocate memory for tripple pointer elements
398 : *-------------------------------------------------------------------------*/
399 :
400 42128 : static ivas_error ivas_alloc_pppMem(
401 : float ****pppMem,
402 : const int16_t dim1,
403 : const int16_t dim2,
404 : const int16_t dim3,
405 : const int16_t allocate_init_flag )
406 : {
407 : int16_t i, j;
408 42128 : float ***localMem = NULL;
409 :
410 42128 : if ( ( localMem = (float ***) malloc( dim1 * sizeof( float ** ) ) ) == NULL )
411 : {
412 0 : return IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for HRTF memory" );
413 : }
414 :
415 2148528 : for ( i = 0; i < dim1; i++ )
416 : {
417 2106400 : if ( ( localMem[i] = (float **) malloc( dim2 * sizeof( float * ) ) ) == NULL )
418 : {
419 0 : return IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for HRTF memory" );
420 : }
421 2106400 : if ( allocate_init_flag == 0 )
422 : {
423 16773600 : for ( j = 0; j < dim2; j++ )
424 : {
425 15765800 : if ( ( localMem[i][j] = (float *) malloc( dim3 * sizeof( float ) ) ) == NULL )
426 : {
427 0 : return IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for HRTF memory" );
428 : }
429 : }
430 : }
431 : }
432 :
433 42128 : *pppMem = localMem;
434 :
435 42128 : return IVAS_ERR_OK;
436 : }
437 :
438 :
439 : /*-------------------------------------------------------------------------*
440 : * ivas_allocate_binaural_hrtf()
441 : *
442 : * Allocate memory for HrtfFastConv structure elements
443 : *-------------------------------------------------------------------------*/
444 :
445 10744 : ivas_error ivas_allocate_binaural_hrtf(
446 : HRTFS_FASTCONV *HrtfFastConv, /* i/o: FASTCONV HRTF structure */
447 : const int16_t n_channels, /* i : number of input channels */
448 : const int16_t allocate_init_flag /* i : Memory allocation flag */
449 : )
450 : {
451 10744 : HrtfFastConv->n_channels = n_channels;
452 :
453 10744 : if ( ( HrtfFastConv->leftReal != NULL ) && ( HrtfFastConv->leftImag != NULL ) && ( HrtfFastConv->rightReal != NULL ) && ( HrtfFastConv->rightImag != NULL ) )
454 : {
455 212 : return IVAS_ERR_OK;
456 : }
457 : else
458 : {
459 10532 : if ( IVAS_ERR_OK != ivas_alloc_pppMem( &HrtfFastConv->leftReal, BINAURAL_CONVBANDS, n_channels, HrtfFastConv->ntaps, allocate_init_flag ) )
460 : {
461 0 : return IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for HrtfFastConv->leftReal" );
462 : }
463 10532 : if ( IVAS_ERR_OK != ivas_alloc_pppMem( &HrtfFastConv->leftImag, BINAURAL_CONVBANDS, n_channels, HrtfFastConv->ntaps, allocate_init_flag ) )
464 : {
465 0 : return IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for HrtfFastConv->leftImag" );
466 : }
467 10532 : if ( IVAS_ERR_OK != ivas_alloc_pppMem( &HrtfFastConv->rightReal, BINAURAL_CONVBANDS, n_channels, HrtfFastConv->ntaps, allocate_init_flag ) )
468 : {
469 0 : return IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for HrtfFastConv->rightReal" );
470 : }
471 10532 : if ( IVAS_ERR_OK != ivas_alloc_pppMem( &HrtfFastConv->rightImag, BINAURAL_CONVBANDS, n_channels, HrtfFastConv->ntaps, allocate_init_flag ) )
472 : {
473 0 : return IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for HrtfFastConv->rightImag" );
474 : }
475 : }
476 :
477 10532 : return IVAS_ERR_OK;
478 : }
479 :
480 :
481 : /*-------------------------------------------------------------------------*
482 : * ivas_binaural_hrtf_open()
483 : *
484 : *
485 : *-------------------------------------------------------------------------*/
486 :
487 19018 : static ivas_error ivas_binaural_hrtf_open(
488 : HRTFS_FASTCONV_HANDLE *hHrtfFastConv, /* i : fastconv HRTF handle */
489 : const AUDIO_CONFIG input_config, /* i : output configuration */
490 : const RENDERER_TYPE renderer_type /* i : renderer type */
491 : )
492 : {
493 : int16_t i, j;
494 : ivas_error error;
495 : int16_t n_channels;
496 :
497 19018 : if ( hHrtfFastConv != NULL && *hHrtfFastConv != NULL )
498 : {
499 : /* Tables already loaded from file */
500 13525 : return IVAS_ERR_OK;
501 : }
502 : else
503 : {
504 : /* Initialise tables from ROM */
505 : HRTFS_FASTCONV *HrtfFastConv;
506 :
507 5493 : if ( ( HrtfFastConv = (HRTFS_FASTCONV *) malloc( sizeof( HRTFS_FASTCONV ) ) ) == NULL )
508 : {
509 0 : return IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Could not allocate memory for FastConv HRTF tables" );
510 : }
511 :
512 5493 : ivas_init_binaural_hrtf( HrtfFastConv );
513 :
514 5493 : if ( input_config == IVAS_AUDIO_CONFIG_BINAURAL || renderer_type == RENDERER_BINAURAL_FASTCONV )
515 : {
516 4009 : HrtfFastConv->FASTCONV_latency_s = FASTCONV_HRIR_latency_s;
517 4009 : HrtfFastConv->ntaps = BINAURAL_NTAPS;
518 : }
519 5493 : if ( input_config == IVAS_AUDIO_CONFIG_HOA2 )
520 : {
521 0 : HrtfFastConv->FASTCONV_latency_s = FASTCONV_HOA2_latency_s;
522 0 : HrtfFastConv->ntaps = BINAURAL_NTAPS_SBA;
523 : }
524 5493 : if ( input_config == IVAS_AUDIO_CONFIG_HOA3 )
525 : {
526 4125 : HrtfFastConv->FASTCONV_latency_s = FASTCONV_HOA3_latency_s;
527 4125 : HrtfFastConv->ntaps = BINAURAL_NTAPS_SBA;
528 : }
529 5493 : if ( input_config == IVAS_AUDIO_CONFIG_FOA )
530 : {
531 0 : HrtfFastConv->FASTCONV_latency_s = FASTCONV_FOA_latency_s;
532 0 : HrtfFastConv->ntaps = BINAURAL_NTAPS_SBA;
533 : }
534 5493 : if ( input_config == IVAS_AUDIO_CONFIG_BINAURAL || renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM )
535 : {
536 1484 : HrtfFastConv->FASTCONV_latency_s = FASTCONV_BRIR_latency_s;
537 1484 : HrtfFastConv->ntaps = BINAURAL_NTAPS_MAX;
538 : }
539 :
540 5493 : HrtfFastConv->allocate_init_flag = 1;
541 :
542 5493 : n_channels = 0;
543 5493 : if ( ( renderer_type == RENDERER_BINAURAL_FASTCONV || renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM ) && input_config != IVAS_AUDIO_CONFIG_INVALID )
544 : {
545 5493 : n_channels = HRTF_LS_CHANNELS;
546 : }
547 :
548 5493 : if ( renderer_type == RENDERER_BINAURAL_FASTCONV )
549 : {
550 4009 : if ( input_config == IVAS_AUDIO_CONFIG_HOA3 )
551 : {
552 3788 : n_channels = HOA3_CHANNELS;
553 : }
554 221 : else if ( input_config == IVAS_AUDIO_CONFIG_HOA2 )
555 : {
556 0 : n_channels = HOA2_CHANNELS;
557 : }
558 221 : else if ( input_config == IVAS_AUDIO_CONFIG_FOA )
559 : {
560 0 : n_channels = FOA_CHANNELS;
561 : }
562 : }
563 :
564 5493 : if ( ( error = ivas_allocate_binaural_hrtf( HrtfFastConv, n_channels, HrtfFastConv->allocate_init_flag ) ) != IVAS_ERR_OK )
565 : {
566 0 : return error;
567 : }
568 :
569 280143 : for ( i = 0; i < BINAURAL_CONVBANDS; i++ )
570 : {
571 274650 : if ( renderer_type == RENDERER_BINAURAL_FASTCONV && HrtfFastConv->n_channels == HRTF_LS_CHANNELS )
572 : {
573 176800 : for ( j = 0; j < HRTF_LS_CHANNELS; j++ )
574 : {
575 165750 : HrtfFastConv->leftReal[i][j] = leftHRIRReal[i][j];
576 165750 : HrtfFastConv->leftImag[i][j] = leftHRIRImag[i][j];
577 165750 : HrtfFastConv->rightReal[i][j] = rightHRIRReal[i][j];
578 165750 : HrtfFastConv->rightImag[i][j] = rightHRIRImag[i][j];
579 : }
580 : }
581 263600 : else if ( renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM && HrtfFastConv->n_channels == HRTF_LS_CHANNELS )
582 : {
583 1187200 : for ( j = 0; j < HRTF_LS_CHANNELS; j++ )
584 : {
585 1113000 : HrtfFastConv->leftReal[i][j] = leftBRIRReal[i][j];
586 1113000 : HrtfFastConv->leftImag[i][j] = leftBRIRImag[i][j];
587 1113000 : HrtfFastConv->rightReal[i][j] = rightBRIRReal[i][j];
588 1113000 : HrtfFastConv->rightImag[i][j] = rightBRIRImag[i][j];
589 : }
590 : }
591 :
592 274650 : if ( input_config == IVAS_AUDIO_CONFIG_HOA3 && HrtfFastConv->n_channels == HOA3_CHANNELS )
593 : {
594 3219800 : for ( j = 0; j < HOA3_CHANNELS; j++ )
595 : {
596 3030400 : HrtfFastConv->leftReal[i][j] = leftHRIRReal_HOA3[i][j];
597 3030400 : HrtfFastConv->leftImag[i][j] = leftHRIRImag_HOA3[i][j];
598 3030400 : HrtfFastConv->rightReal[i][j] = rightHRIRReal_HOA3[i][j];
599 3030400 : HrtfFastConv->rightImag[i][j] = rightHRIRImag_HOA3[i][j];
600 : }
601 : }
602 :
603 : /* Note: IVAS_AUDIO_CONFIG_HOA2 and IVAS_AUDIO_CONFIG_FOA input configs. are not relevant in internal renderer
604 : as SBA to binaural always synthesizes HOA3 output for binauralization. However, the external renderer can use them. */
605 274650 : if ( input_config == IVAS_AUDIO_CONFIG_HOA2 && HrtfFastConv->n_channels == HOA2_CHANNELS )
606 : {
607 0 : for ( j = 0; j < HOA2_CHANNELS; j++ )
608 : {
609 0 : HrtfFastConv->leftReal[i][j] = leftHRIRReal_HOA2[i][j];
610 0 : HrtfFastConv->leftImag[i][j] = leftHRIRImag_HOA2[i][j];
611 0 : HrtfFastConv->rightReal[i][j] = rightHRIRReal_HOA2[i][j];
612 0 : HrtfFastConv->rightImag[i][j] = rightHRIRImag_HOA2[i][j];
613 : }
614 : }
615 :
616 274650 : if ( input_config == IVAS_AUDIO_CONFIG_FOA && HrtfFastConv->n_channels == FOA_CHANNELS )
617 : {
618 0 : for ( j = 0; j < FOA_CHANNELS; j++ )
619 : {
620 0 : HrtfFastConv->leftReal[i][j] = leftHRIRReal_FOA[i][j];
621 0 : HrtfFastConv->leftImag[i][j] = leftHRIRImag_FOA[i][j];
622 0 : HrtfFastConv->rightReal[i][j] = rightHRIRReal_FOA[i][j];
623 0 : HrtfFastConv->rightImag[i][j] = rightHRIRImag_FOA[i][j];
624 : }
625 : }
626 : }
627 :
628 5493 : mvr2r( fastconvReverberationTimes, HrtfFastConv->fastconvReverberationTimes, CLDFB_NO_CHANNELS_MAX );
629 5493 : mvr2r( fastconvReverberationEneCorrections, HrtfFastConv->fastconvReverberationEneCorrections, CLDFB_NO_CHANNELS_MAX );
630 :
631 5493 : *hHrtfFastConv = HrtfFastConv;
632 :
633 5493 : return IVAS_ERR_OK;
634 : }
635 : }
636 :
637 :
638 : /*-------------------------------------------------------------------------*
639 : * ivas_binaural_obtain_DMX()
640 : *
641 : *
642 : *-------------------------------------------------------------------------*/
643 :
644 3957994 : static void ivas_binaural_obtain_DMX(
645 : const int16_t numTimeSlots,
646 : BINAURAL_RENDERER_HANDLE hBinRenderer, /* i/o: fastconv binaural renderer handle */
647 : float RealBuffer[][CLDFB_SLOTS_PER_SUBFRAME][CLDFB_NO_CHANNELS_MAX], /* i : Contains the LS signals */
648 : float ImagBuffer[][CLDFB_SLOTS_PER_SUBFRAME][CLDFB_NO_CHANNELS_MAX], /* i : Contains the LS signals */
649 : float realDMX[][CLDFB_SLOTS_PER_SUBFRAME][CLDFB_NO_CHANNELS_MAX],
650 : float imagDMX[][CLDFB_SLOTS_PER_SUBFRAME][CLDFB_NO_CHANNELS_MAX] )
651 : {
652 : int16_t chIdx, bandIdx, k;
653 :
654 3957994 : if ( hBinRenderer->ivas_format == MC_FORMAT )
655 : {
656 : /* Obtain the downmix */
657 : float P_in[CLDFB_NO_CHANNELS_MAX];
658 : float P_out, factEQ;
659 : int16_t chOutIdx;
660 : float temp1, temp2;
661 :
662 6649320 : for ( k = 0; k < numTimeSlots; k++ )
663 : {
664 15958368 : for ( chOutIdx = 0; chOutIdx < BINAURAL_CHANNELS; chOutIdx++ )
665 : {
666 10638912 : set_zero( realDMX[chOutIdx][k], CLDFB_NO_CHANNELS_MAX );
667 10638912 : set_zero( imagDMX[chOutIdx][k], CLDFB_NO_CHANNELS_MAX );
668 : }
669 : }
670 :
671 3989592 : for ( chOutIdx = 0; chOutIdx < BINAURAL_CHANNELS; chOutIdx++ )
672 : {
673 2659728 : set_zero( P_in, hBinRenderer->conv_band );
674 :
675 26321760 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
676 : {
677 23662032 : float dmxConst = dmxmtx_table[chOutIdx][chIdx];
678 :
679 1065584912 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
680 : {
681 5209614400 : for ( k = 0; k < numTimeSlots; k++ )
682 : {
683 4167691520 : temp1 = RealBuffer[chIdx][k][bandIdx] * dmxConst;
684 4167691520 : temp2 = ImagBuffer[chIdx][k][bandIdx] * dmxConst;
685 4167691520 : realDMX[chOutIdx][k][bandIdx] += temp1;
686 4167691520 : imagDMX[chOutIdx][k][bandIdx] += temp2;
687 :
688 4167691520 : P_in[bandIdx] += temp1 * temp1 + temp2 * temp2;
689 : }
690 : }
691 : }
692 :
693 120536368 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
694 : {
695 117876640 : P_out = 0.f;
696 589383200 : for ( k = 0; k < numTimeSlots; k++ )
697 : {
698 471506560 : temp1 = realDMX[chOutIdx][k][bandIdx];
699 471506560 : temp2 = imagDMX[chOutIdx][k][bandIdx];
700 471506560 : P_out += temp1 * temp1 + temp2 * temp2;
701 : }
702 117876640 : factEQ = sqrtf( P_in[bandIdx] / ( P_out + 1e-20f ) );
703 117876640 : if ( ( factEQ <= 1e-20f ) || ( P_in[bandIdx] <= 1e-20f ) || ( P_out <= 1e-20f ) )
704 : {
705 1164914 : factEQ = 1.0f;
706 : }
707 :
708 117876640 : factEQ = max( min( factEQ, 2.0f ), 0.5f );
709 589383200 : for ( k = 0; k < numTimeSlots; k++ )
710 : {
711 471506560 : realDMX[chOutIdx][k][bandIdx] *= factEQ;
712 471506560 : imagDMX[chOutIdx][k][bandIdx] *= factEQ;
713 : }
714 : }
715 : }
716 : }
717 2628130 : else if ( hBinRenderer->ivas_format == SBA_FORMAT || hBinRenderer->ivas_format == MASA_FORMAT )
718 : {
719 : float *outRealLeftPtr, *outImagLeftPtr, *outRealRightPtr, *outImagRightPtr;
720 : float *inRealPtr, *inImagPtr;
721 :
722 : /*compute DMX */
723 13101331 : for ( k = 0; k < numTimeSlots; k++ )
724 : {
725 10473201 : outRealLeftPtr = realDMX[0][k];
726 10473201 : outImagLeftPtr = imagDMX[0][k];
727 10473201 : outRealRightPtr = realDMX[1][k];
728 10473201 : outImagRightPtr = imagDMX[1][k];
729 10473201 : set_zero( outRealLeftPtr, CLDFB_NO_CHANNELS_MAX );
730 10473201 : set_zero( outImagLeftPtr, CLDFB_NO_CHANNELS_MAX );
731 10473201 : set_zero( outRealRightPtr, CLDFB_NO_CHANNELS_MAX );
732 10473201 : set_zero( outImagRightPtr, CLDFB_NO_CHANNELS_MAX );
733 :
734 : /*Ambisonics input requires different processing*/
735 10473201 : if ( hBinRenderer->nInChannels == HOA3_CHANNELS )
736 : {
737 : float *inRealPtr_W, *inImagPtr_W;
738 : float *inRealPtr_Y, *inImagPtr_Y;
739 :
740 6988113 : inRealPtr_W = (float *) &( RealBuffer[0][k][0] );
741 6988113 : inImagPtr_W = (float *) &( ImagBuffer[0][k][0] );
742 :
743 6988113 : inRealPtr_Y = (float *) &( RealBuffer[1][k][0] );
744 6988113 : inImagPtr_Y = (float *) &( ImagBuffer[1][k][0] );
745 :
746 301812053 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
747 : {
748 294823940 : outRealLeftPtr[bandIdx] = inRealPtr_W[bandIdx] + inRealPtr_Y[bandIdx];
749 294823940 : outImagLeftPtr[bandIdx] = inImagPtr_W[bandIdx] + inImagPtr_Y[bandIdx];
750 :
751 294823940 : outRealRightPtr[bandIdx] = inRealPtr_W[bandIdx] - inRealPtr_Y[bandIdx];
752 294823940 : outImagRightPtr[bandIdx] = inImagPtr_W[bandIdx] - inImagPtr_Y[bandIdx];
753 : }
754 : }
755 : else
756 : {
757 41821056 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
758 : {
759 38335968 : float foa_const = hBinRenderer->hReverb->foa_enc[chIdx][1];
760 :
761 38335968 : inRealPtr = (float *) &( RealBuffer[chIdx][k][0] );
762 38335968 : inImagPtr = (float *) &( ImagBuffer[chIdx][k][0] );
763 :
764 1610065248 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
765 : {
766 1571729280 : outRealLeftPtr[bandIdx] += inRealPtr[bandIdx] * ( 1.f + foa_const );
767 1571729280 : outImagLeftPtr[bandIdx] += inImagPtr[bandIdx] * ( 1.f + foa_const );
768 :
769 1571729280 : outRealRightPtr[bandIdx] += inRealPtr[bandIdx] * ( 1.f - foa_const );
770 1571729280 : outImagRightPtr[bandIdx] += inImagPtr[bandIdx] * ( 1.f - foa_const );
771 : }
772 : }
773 : }
774 : }
775 : }
776 :
777 3957994 : return;
778 : }
779 :
780 :
781 : /*-------------------------------------------------------------------------
782 : * ivas_rend_openCldfbRend()
783 : *
784 : * Allocate and initialize CLDFB fast conv renderer handle
785 : *------------------------------------------------------------------------*/
786 :
787 8 : ivas_error ivas_rend_openCldfbRend(
788 : CLDFB_REND_WRAPPER *pCldfbRend,
789 : const AUDIO_CONFIG inConfig,
790 : const AUDIO_CONFIG outConfig,
791 : const MULTI_BIN_REND_POSE_DATA *pMultiBinPoseData,
792 : const int32_t output_Fs )
793 : {
794 : BINAURAL_RENDERER_HANDLE hBinRenderer;
795 : int16_t convBand;
796 : ivas_error error;
797 :
798 : /*-----------------------------------------------------------------*
799 : * prepare library opening
800 : *-----------------------------------------------------------------*/
801 :
802 8 : if ( ( hBinRenderer = (BINAURAL_RENDERER_HANDLE) malloc( sizeof( BINAURAL_RENDERER ) ) ) == NULL )
803 : {
804 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Binaural Renderer\n" ) );
805 : }
806 :
807 8 : if ( ( hBinRenderer->hInputSetup = (IVAS_OUTPUT_SETUP_HANDLE) malloc( sizeof( IVAS_OUTPUT_SETUP ) ) ) == NULL )
808 : {
809 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for output setup Binaural Renderer\n" ) );
810 : }
811 :
812 8 : hBinRenderer->rotInCldfb = 1;
813 8 : hBinRenderer->ivas_format = SBA_FORMAT;
814 :
815 8 : hBinRenderer->max_band = (int16_t) ( ( BINAURAL_MAXBANDS * output_Fs ) / 48000 );
816 8 : convBand = hBinRenderer->max_band;
817 :
818 8 : hBinRenderer->timeSlots = MAX_PARAM_SPATIAL_SUBFRAMES; /* Corresponds to 5 msec sound to motion latency */
819 :
820 8 : if ( convBand > BINAURAL_CONVBANDS )
821 : {
822 8 : hBinRenderer->conv_band = BINAURAL_CONVBANDS;
823 : }
824 : else
825 : {
826 0 : hBinRenderer->conv_band = convBand;
827 : }
828 :
829 8 : ivas_output_init( hBinRenderer->hInputSetup, inConfig );
830 8 : if ( ( error = getAudioConfigNumChannels( inConfig, &hBinRenderer->hInputSetup->nchan_out_woLFE ) ) != IVAS_ERR_OK )
831 : {
832 0 : return error;
833 : }
834 :
835 8 : if ( outConfig == IVAS_AUDIO_CONFIG_BINAURAL_SPLIT_CODED || outConfig == IVAS_AUDIO_CONFIG_BINAURAL_SPLIT_PCM )
836 : {
837 : #ifdef SPLIT_REND_WITH_HEAD_ROT_DEBUG
838 : hBinRenderer->numPoses = pMultiBinPoseData->num_poses + 1;
839 : #else
840 8 : hBinRenderer->numPoses = pMultiBinPoseData->num_poses;
841 : #endif
842 : }
843 : else
844 : {
845 0 : hBinRenderer->numPoses = 1;
846 : }
847 :
848 : /* Load HRTF tables */
849 8 : if ( ( error = ivas_binaural_hrtf_open( &pCldfbRend->hHrtfFastConv, hBinRenderer->hInputSetup->output_config, RENDERER_BINAURAL_FASTCONV ) ) != IVAS_ERR_OK )
850 : {
851 0 : return error;
852 : }
853 :
854 : /* Allocate memories and buffers needed for convolutional module */
855 8 : if ( ( error = ivas_binRenderer_convModuleOpen( hBinRenderer, RENDERER_BINAURAL_FASTCONV, hBinRenderer->hInputSetup->is_loudspeaker_setup, inConfig, pCldfbRend->hHrtfFastConv, hBinRenderer->numPoses ) ) != IVAS_ERR_OK )
856 : {
857 0 : return error;
858 : }
859 :
860 8 : pCldfbRend->binaural_latency_ns = (int32_t) ( pCldfbRend->hHrtfFastConv->FASTCONV_latency_s * 1000000000.f );
861 :
862 8 : hBinRenderer->hReverb = NULL;
863 8 : hBinRenderer->hEFAPdata = NULL;
864 :
865 8 : pCldfbRend->hCldfbRend = hBinRenderer;
866 :
867 8 : return IVAS_ERR_OK;
868 : }
869 :
870 :
871 : /*-------------------------------------------------------------------------
872 : * ivas_binRenderer_open()
873 : *
874 : * Open fastconv binaural renderer handle
875 : *-------------------------------------------------------------------------*/
876 :
877 19010 : ivas_error ivas_binRenderer_open(
878 : Decoder_Struct *st_ivas /* i/o: IVAS decoder structure */
879 : )
880 : {
881 : BINAURAL_RENDERER_HANDLE hBinRenderer;
882 : int16_t convBand, k;
883 : ivas_error error;
884 : const IVAS_ROOM_ACOUSTICS_CONFIG_DATA *pRoomAcoustics;
885 :
886 : /*-----------------------------------------------------------------*
887 : * prepare library opening
888 : *-----------------------------------------------------------------*/
889 :
890 19010 : if ( ( hBinRenderer = (BINAURAL_RENDERER_HANDLE) malloc( sizeof( BINAURAL_RENDERER ) ) ) == NULL )
891 : {
892 0 : return ( IVAS_ERROR( IVAS_ERR_FAILED_ALLOC, "Can not allocate memory for Binaural Renderer\n" ) );
893 : }
894 :
895 19010 : hBinRenderer->hInputSetup = &st_ivas->hIntSetup;
896 :
897 : /* Define of head rotation has to be done in binRendeder in CLDFB*/
898 19010 : hBinRenderer->rotInCldfb = 0;
899 19010 : if ( st_ivas->ivas_format == MC_FORMAT || st_ivas->ivas_format == SBA_FORMAT || st_ivas->ivas_format == SBA_ISM_FORMAT )
900 : {
901 19010 : hBinRenderer->rotInCldfb = 1;
902 : }
903 :
904 19010 : if ( st_ivas->hDecoderConfig->output_config == IVAS_AUDIO_CONFIG_BINAURAL_SPLIT_CODED || st_ivas->hDecoderConfig->output_config == IVAS_AUDIO_CONFIG_BINAURAL_SPLIT_PCM )
905 : {
906 : #ifdef SPLIT_REND_WITH_HEAD_ROT_DEBUG
907 : hBinRenderer->numPoses = st_ivas->hSplitBinRend->splitrend.multiBinPoseData.num_poses + 1;
908 : #else
909 986 : hBinRenderer->numPoses = st_ivas->hSplitBinRend->splitrend.multiBinPoseData.num_poses;
910 : #endif
911 : }
912 : else
913 : {
914 18024 : hBinRenderer->numPoses = 1;
915 : }
916 :
917 : /* Declare some common variables needed for renderer */
918 : /* Which format used for binaural rendering (needed for late reverb) ? MC or SBA */
919 19010 : if ( st_ivas->hIntSetup.is_loudspeaker_setup )
920 : {
921 7259 : hBinRenderer->ivas_format = MC_FORMAT;
922 : }
923 : else
924 : {
925 11751 : hBinRenderer->ivas_format = SBA_FORMAT;
926 : }
927 19010 : hBinRenderer->max_band = (int16_t) ( ( BINAURAL_MAXBANDS * st_ivas->hDecoderConfig->output_Fs ) / 48000 );
928 19010 : convBand = hBinRenderer->max_band;
929 :
930 19010 : hBinRenderer->timeSlots = MAX_PARAM_SPATIAL_SUBFRAMES; /* Corresponds to 5 msec sound to motion latency */
931 :
932 19010 : if ( convBand > BINAURAL_CONVBANDS )
933 : {
934 10698 : hBinRenderer->conv_band = BINAURAL_CONVBANDS;
935 : }
936 : else
937 : {
938 8312 : hBinRenderer->conv_band = convBand;
939 : }
940 :
941 : /*LFE rendering switched off by default*/
942 19010 : hBinRenderer->render_lfe = 0;
943 :
944 19010 : if ( st_ivas->ivas_format != ISM_FORMAT && st_ivas->hIntSetup.is_loudspeaker_setup )
945 : {
946 7259 : hBinRenderer->render_lfe = 1;
947 : }
948 :
949 19010 : if ( st_ivas->hHrtfFastConv == NULL && st_ivas->hDecoderConfig->Opt_HRTF_binary )
950 : {
951 0 : return IVAS_ERROR( IVAS_ERR_INTERNAL, "HRTF binary file present but not used in FastConv renderer" );
952 : }
953 :
954 : /* Load HRTF tables */
955 19010 : if ( ( error = ivas_binaural_hrtf_open( &st_ivas->hHrtfFastConv, st_ivas->hIntSetup.output_config, st_ivas->renderer_type ) ) != IVAS_ERR_OK )
956 : {
957 0 : return error;
958 : }
959 :
960 19010 : if ( st_ivas->renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM && ( st_ivas->hIntSetup.is_loudspeaker_setup == 0 ) )
961 481 : {
962 : IVAS_OUTPUT_SETUP out_setup;
963 :
964 : /* Allocate memories and buffers needed for convolutional module in CICP19 */
965 481 : if ( ( error = ivas_binRenderer_convModuleOpen( hBinRenderer, st_ivas->renderer_type, 1, IVAS_AUDIO_CONFIG_7_1_4, st_ivas->hHrtfFastConv, hBinRenderer->numPoses ) ) != IVAS_ERR_OK )
966 : {
967 0 : return error;
968 : }
969 :
970 481 : ivas_output_init( &out_setup, IVAS_AUDIO_CONFIG_7_1_4 );
971 :
972 481 : if ( st_ivas->hoa_dec_mtx == NULL )
973 : {
974 481 : if ( ( error = ivas_sba_get_hoa_dec_matrix( out_setup, &st_ivas->hoa_dec_mtx, st_ivas->hIntSetup.ambisonics_order ) ) != IVAS_ERR_OK )
975 : {
976 0 : return error;
977 : }
978 : }
979 :
980 481 : hBinRenderer->hoa_dec_mtx = st_ivas->hoa_dec_mtx;
981 481 : st_ivas->binaural_latency_ns = (int32_t) ( st_ivas->hHrtfFastConv->FASTCONV_latency_s * 1000000000.f );
982 : }
983 : else
984 : {
985 : /* Allocate memories and buffers needed for convolutional module */
986 18529 : if ( ( error = ivas_binRenderer_convModuleOpen( hBinRenderer, st_ivas->renderer_type, st_ivas->hIntSetup.is_loudspeaker_setup, st_ivas->hIntSetup.output_config, st_ivas->hHrtfFastConv, hBinRenderer->numPoses ) ) != IVAS_ERR_OK )
987 : {
988 0 : return error;
989 : }
990 :
991 18529 : st_ivas->binaural_latency_ns = (int32_t) ( st_ivas->hHrtfFastConv->FASTCONV_latency_s * 1000000000.f );
992 : }
993 :
994 : /* Allocate memories needed for reverb module */
995 19010 : if ( st_ivas->renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM || ( st_ivas->renderer_type == RENDERER_BINAURAL_FASTCONV && st_ivas->hOutSetup.output_config == IVAS_AUDIO_CONFIG_BINAURAL_ROOM_REVERB ) )
996 : {
997 9791 : pRoomAcoustics = ( st_ivas->hOutSetup.output_config == IVAS_AUDIO_CONFIG_BINAURAL_ROOM_REVERB ) ? &( st_ivas->hRenderConfig->roomAcoustics ) : NULL;
998 :
999 9791 : if ( ( error = ivas_binaural_reverb_init( &( hBinRenderer->hReverb ),
1000 : st_ivas->hHrtfStatistics,
1001 9791 : hBinRenderer->conv_band,
1002 9791 : hBinRenderer->timeSlots,
1003 : pRoomAcoustics,
1004 9791 : st_ivas->hDecoderConfig->output_Fs,
1005 9791 : st_ivas->hHrtfFastConv->fastconvReverberationTimes,
1006 9791 : st_ivas->hHrtfFastConv->fastconvReverberationEneCorrections,
1007 : NULL ) ) != IVAS_ERR_OK )
1008 :
1009 : {
1010 0 : return error;
1011 : }
1012 : }
1013 : else
1014 : {
1015 9219 : hBinRenderer->hReverb = NULL;
1016 : }
1017 :
1018 19010 : hBinRenderer->hEFAPdata = NULL;
1019 :
1020 19010 : if ( hBinRenderer->hReverb != NULL && hBinRenderer->nInChannels != HOA3_CHANNELS )
1021 : {
1022 5817 : if ( hBinRenderer->hInputSetup->is_loudspeaker_setup == 0 )
1023 : {
1024 5772 : for ( k = 0; k < 11; k++ )
1025 : {
1026 5291 : ivas_dirac_dec_get_response( (int16_t) ls_azimuth_CICP19[k], (int16_t) ls_elevation_CICP19[k], hBinRenderer->hReverb->foa_enc[k], 1 );
1027 : }
1028 : }
1029 : #ifdef IVAS_RTPDUMP
1030 5336 : else if ( st_ivas->ivas_format == MC_FORMAT && ( st_ivas->hDecoderConfig->Opt_Headrotation || st_ivas->hDecoderConfig->Opt_ExternalOrientation || st_ivas->hCombinedOrientationData ) )
1031 : #else
1032 : else if ( st_ivas->ivas_format == MC_FORMAT && ( st_ivas->hDecoderConfig->Opt_Headrotation || st_ivas->hDecoderConfig->Opt_ExternalOrientation ) )
1033 : #endif
1034 : {
1035 14 : if ( ( error = efap_init_data( &( st_ivas->hEFAPdata ), st_ivas->hIntSetup.ls_azimuth, st_ivas->hIntSetup.ls_elevation, st_ivas->hIntSetup.nchan_out_woLFE, EFAP_MODE_EFAP ) ) != IVAS_ERR_OK )
1036 : {
1037 0 : return error;
1038 : }
1039 :
1040 : /* Copy handles to bin renderer handle*/
1041 14 : hBinRenderer->hEFAPdata = st_ivas->hEFAPdata;
1042 : }
1043 : }
1044 :
1045 : /* Copy the handles to main handle */
1046 19010 : st_ivas->hBinRenderer = hBinRenderer;
1047 :
1048 19010 : return IVAS_ERR_OK;
1049 : }
1050 :
1051 :
1052 : /*-------------------------------------------------------------------------
1053 : * ivas_binRenderer_convModuleClose()
1054 : *
1055 : * Close convolution module handle of fastconv binaural renderer
1056 : *------------------------------------------------------------------------*/
1057 :
1058 19018 : static void ivas_binRenderer_convModuleClose(
1059 : BINAURAL_RENDERER_HANDLE *hBinRenderer, /* i/o: fastconv binaural renderer handle */
1060 : const int16_t num_poses /* i : number of poses */
1061 : )
1062 : {
1063 : int16_t bandIdx, chIdx;
1064 : int16_t posIdx;
1065 : BINRENDERER_CONV_MODULE_HANDLE hBinRenConvModule;
1066 :
1067 19018 : hBinRenConvModule = ( *hBinRenderer )->hBinRenConvModule;
1068 :
1069 19018 : if ( hBinRenConvModule == NULL )
1070 : {
1071 0 : return;
1072 : }
1073 :
1074 790638 : for ( bandIdx = 0; bandIdx < ( *hBinRenderer )->conv_band; bandIdx++ )
1075 : {
1076 771620 : free( hBinRenConvModule->filterTapsLeftReal[bandIdx] );
1077 771620 : hBinRenConvModule->filterTapsLeftReal[bandIdx] = NULL;
1078 :
1079 771620 : free( hBinRenConvModule->filterTapsLeftImag[bandIdx] );
1080 771620 : hBinRenConvModule->filterTapsLeftImag[bandIdx] = NULL;
1081 :
1082 771620 : free( hBinRenConvModule->filterTapsRightReal[bandIdx] );
1083 771620 : hBinRenConvModule->filterTapsRightReal[bandIdx] = NULL;
1084 :
1085 771620 : free( hBinRenConvModule->filterTapsRightImag[bandIdx] );
1086 771620 : hBinRenConvModule->filterTapsRightImag[bandIdx] = NULL;
1087 : }
1088 :
1089 19018 : free( hBinRenConvModule->filterTapsLeftReal );
1090 19018 : hBinRenConvModule->filterTapsLeftReal = NULL;
1091 :
1092 19018 : free( hBinRenConvModule->filterTapsLeftImag );
1093 19018 : hBinRenConvModule->filterTapsLeftImag = NULL;
1094 :
1095 19018 : free( hBinRenConvModule->filterTapsRightReal );
1096 19018 : hBinRenConvModule->filterTapsRightReal = NULL;
1097 :
1098 19018 : free( hBinRenConvModule->filterTapsRightImag );
1099 19018 : hBinRenConvModule->filterTapsRightImag = NULL;
1100 :
1101 40716 : for ( posIdx = 0; posIdx < num_poses; posIdx++ )
1102 : {
1103 927318 : for ( bandIdx = 0; bandIdx < ( *hBinRenderer )->conv_band; bandIdx++ )
1104 : {
1105 12946380 : for ( chIdx = 0; chIdx < ( *hBinRenderer )->nInChannels; chIdx++ )
1106 : {
1107 12040760 : free( hBinRenConvModule->filterStatesLeftReal[posIdx][bandIdx][chIdx] );
1108 12040760 : hBinRenConvModule->filterStatesLeftReal[posIdx][bandIdx][chIdx] = NULL;
1109 :
1110 12040760 : free( hBinRenConvModule->filterStatesLeftImag[posIdx][bandIdx][chIdx] );
1111 12040760 : hBinRenConvModule->filterStatesLeftImag[posIdx][bandIdx][chIdx] = NULL;
1112 : }
1113 :
1114 905620 : free( hBinRenConvModule->filterStatesLeftReal[posIdx][bandIdx] );
1115 905620 : hBinRenConvModule->filterStatesLeftReal[posIdx][bandIdx] = NULL;
1116 :
1117 905620 : free( hBinRenConvModule->filterStatesLeftImag[posIdx][bandIdx] );
1118 905620 : hBinRenConvModule->filterStatesLeftImag[posIdx][bandIdx] = NULL;
1119 : }
1120 :
1121 21698 : free( hBinRenConvModule->filterStatesLeftReal[posIdx] );
1122 21698 : hBinRenConvModule->filterStatesLeftReal[posIdx] = NULL;
1123 :
1124 21698 : free( hBinRenConvModule->filterStatesLeftImag[posIdx] );
1125 21698 : hBinRenConvModule->filterStatesLeftImag[posIdx] = NULL;
1126 : }
1127 19018 : free( hBinRenConvModule->filterStatesLeftReal );
1128 19018 : hBinRenConvModule->filterStatesLeftReal = NULL;
1129 :
1130 19018 : free( hBinRenConvModule->filterStatesLeftImag );
1131 19018 : hBinRenConvModule->filterStatesLeftImag = NULL;
1132 :
1133 19018 : free( ( *hBinRenderer )->hBinRenConvModule );
1134 19018 : ( *hBinRenderer )->hBinRenConvModule = NULL;
1135 :
1136 19018 : return;
1137 : }
1138 :
1139 :
1140 : /*-------------------------------------------------------------------------
1141 : * ivas_binRenderer_close()
1142 : *
1143 : * Close fastconv binaural renderer memories
1144 : *------------------------------------------------------------------------*/
1145 :
1146 101902 : void ivas_binRenderer_close(
1147 : BINAURAL_RENDERER_HANDLE *hBinRenderer /* i/o: fastconv binaural renderer handle */
1148 : )
1149 : {
1150 101902 : if ( hBinRenderer == NULL || *hBinRenderer == NULL )
1151 : {
1152 82884 : return;
1153 : }
1154 :
1155 19018 : if ( ( *hBinRenderer )->hBinRenConvModule != NULL )
1156 : {
1157 19018 : ivas_binRenderer_convModuleClose( hBinRenderer, ( *hBinRenderer )->numPoses );
1158 : }
1159 :
1160 19018 : if ( ( *hBinRenderer )->hReverb != NULL )
1161 : {
1162 9791 : ivas_binaural_reverb_close( &( ( *hBinRenderer )->hReverb ) );
1163 : }
1164 :
1165 19018 : free( *hBinRenderer );
1166 19018 : *hBinRenderer = NULL;
1167 :
1168 19018 : return;
1169 : }
1170 :
1171 :
1172 : /*-------------------------------------------------------------------------
1173 : * ivas_free_pppHrtfMem()
1174 : *
1175 : * Free fastconv binaural renderer hrtf memories
1176 : *------------------------------------------------------------------------*/
1177 :
1178 42128 : static void ivas_free_pppHrtfMem(
1179 : float ****ppppHRIR,
1180 : const int16_t dim,
1181 : const int16_t alloc_init )
1182 : {
1183 : int16_t i, j;
1184 :
1185 42128 : if ( *ppppHRIR != NULL )
1186 : {
1187 2148528 : for ( i = 0; i < BINAURAL_CONVBANDS; i++ )
1188 : {
1189 2106400 : if ( alloc_init == 0 )
1190 : {
1191 16773600 : for ( j = 0; j < dim; j++ )
1192 : {
1193 15765800 : free( ( *ppppHRIR )[i][j] );
1194 15765800 : ( *ppppHRIR )[i][j] = NULL;
1195 : }
1196 : }
1197 2106400 : free( ( *ppppHRIR )[i] );
1198 2106400 : ( *ppppHRIR )[i] = NULL;
1199 : }
1200 42128 : free( *ppppHRIR );
1201 42128 : *ppppHRIR = NULL;
1202 : }
1203 :
1204 42128 : return;
1205 : }
1206 :
1207 :
1208 : /*-------------------------------------------------------------------------
1209 : * ivas_binaural_hrtf_close()
1210 : *
1211 : * Close fastconv binaural renderer hrtf memories
1212 : *------------------------------------------------------------------------*/
1213 :
1214 115044 : void ivas_binaural_hrtf_close(
1215 : HRTFS_FASTCONV_HANDLE *hHrtfFastConv /* i : fastconv HRTF handle */
1216 : )
1217 : {
1218 : int16_t allocate_init_flag;
1219 : int16_t n_channels;
1220 :
1221 115044 : if ( hHrtfFastConv == NULL || *hHrtfFastConv == NULL )
1222 : {
1223 104512 : return;
1224 : }
1225 :
1226 10532 : allocate_init_flag = ( *hHrtfFastConv )->allocate_init_flag;
1227 10532 : n_channels = ( *hHrtfFastConv )->n_channels;
1228 :
1229 10532 : ivas_free_pppHrtfMem( &( *hHrtfFastConv )->leftReal, n_channels, allocate_init_flag );
1230 10532 : ivas_free_pppHrtfMem( &( *hHrtfFastConv )->leftImag, n_channels, allocate_init_flag );
1231 10532 : ivas_free_pppHrtfMem( &( *hHrtfFastConv )->rightReal, n_channels, allocate_init_flag );
1232 10532 : ivas_free_pppHrtfMem( &( *hHrtfFastConv )->rightImag, n_channels, allocate_init_flag );
1233 :
1234 10532 : return;
1235 : }
1236 :
1237 :
1238 : /*-------------------------------------------------------------------------*
1239 : * ivas_binaural_add_LFE()
1240 : *
1241 : * The functions adds the LFE to the left and right channels after binaural rendering
1242 : *-------------------------------------------------------------------------*/
1243 :
1244 2341759 : void ivas_binaural_add_LFE(
1245 : Decoder_Struct *st_ivas, /* i/o: IVAS decoder structure */
1246 : int16_t output_frame, /* i : length of input frame */
1247 : float *input_f[], /* i : transport channels */
1248 : float *output_f[] /* o : synthesized core-coder transport channels/DirAC output */
1249 : )
1250 : {
1251 : int16_t render_lfe, idx_lfe;
1252 : float gain;
1253 : float lfe_tc[L_FRAME48k];
1254 :
1255 2341759 : if ( st_ivas->hBinRenderer != NULL )
1256 : {
1257 65537 : render_lfe = st_ivas->hBinRenderer->render_lfe;
1258 : }
1259 : else
1260 : {
1261 2276222 : render_lfe = TRUE;
1262 : }
1263 :
1264 2341759 : if ( render_lfe )
1265 : {
1266 2341759 : if ( st_ivas->renderer_type == RENDERER_BINAURAL_OBJECTS_TD )
1267 : {
1268 671934 : gain = GAIN_LFE;
1269 : }
1270 : else
1271 : {
1272 1669825 : gain = ( ( st_ivas->hCrendWrapper != NULL ) && ( st_ivas->hCrendWrapper->hHrtfCrend != NULL ) ) ? st_ivas->hCrendWrapper->hHrtfCrend->gain_lfe : GAIN_LFE;
1273 : }
1274 :
1275 4606691 : for ( idx_lfe = 0; idx_lfe < st_ivas->hIntSetup.num_lfe; idx_lfe++ )
1276 : {
1277 2264932 : v_multc( input_f[st_ivas->hIntSetup.index_lfe[idx_lfe]], gain, lfe_tc, output_frame );
1278 : /* copy LFE to left and right channels */
1279 2264932 : v_add( output_f[0], lfe_tc, output_f[0], output_frame );
1280 2264932 : v_add( output_f[1], lfe_tc, output_f[1], output_frame );
1281 : }
1282 : }
1283 :
1284 2341759 : return;
1285 : }
1286 :
1287 :
1288 : /*-------------------------------------------------------------------------
1289 : * ivas_binRenderer()
1290 : *
1291 : * Fastconv binaural renderer main function
1292 : *-------------------------------------------------------------------------*/
1293 :
1294 6949737 : void ivas_binRenderer(
1295 : BINAURAL_RENDERER_HANDLE hBinRenderer, /* i/o: binaural renderer handle */
1296 : const MULTI_BIN_REND_POSE_DATA *pMultiBinPoseData,
1297 : COMBINED_ORIENTATION_HANDLE hCombinedOrientationData, /* i : combined head and external orientation handle*/
1298 : const int16_t numTimeSlots, /* i : number of time slots to render */
1299 : #ifdef SPLIT_REND_WITH_HEAD_ROT_DEBUG
1300 : HEAD_TRACK_DATA_HANDLE hPostRendHeadTrackData,
1301 : #endif
1302 : float Cldfb_RealBuffer_Binaural[][BINAURAL_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX], /* o : Rotated Binaural signals */
1303 : float Cldfb_ImagBuffer_Binaural[][BINAURAL_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX], /* o : Rotated Binaural signals */
1304 : float RealBuffer[][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX], /* i : LS signals */
1305 : float ImagBuffer[][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX] /* i : LS signals */
1306 : )
1307 : {
1308 : int16_t chIdx, k;
1309 : int16_t pos_idx, num_poses;
1310 : float RealBuffer_local[MAX_OUTPUT_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX];
1311 : float ImagBuffer_local[MAX_OUTPUT_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX];
1312 :
1313 6949737 : push_wmops( "fastconv_binaural_rendering" );
1314 6949737 : num_poses = hBinRenderer->numPoses;
1315 :
1316 : /* Compute Convolution */
1317 : /* memory reset for the binaural output */
1318 15844598 : for ( pos_idx = 0; pos_idx < num_poses; pos_idx++ )
1319 : {
1320 26684583 : for ( chIdx = 0; chIdx < BINAURAL_CHANNELS; chIdx++ )
1321 : {
1322 88035480 : for ( k = 0; k < numTimeSlots; k++ )
1323 : {
1324 70245758 : set_zero( Cldfb_RealBuffer_Binaural[pos_idx][chIdx][k], CLDFB_NO_CHANNELS_MAX );
1325 70245758 : set_zero( Cldfb_ImagBuffer_Binaural[pos_idx][chIdx][k], CLDFB_NO_CHANNELS_MAX );
1326 : }
1327 : }
1328 : }
1329 :
1330 106703777 : for ( chIdx = 0; chIdx < hBinRenderer->hInputSetup->nchan_out_woLFE; chIdx++ )
1331 : {
1332 495822024 : for ( k = 0; k < numTimeSlots; k++ )
1333 : {
1334 396067984 : mvr2r( RealBuffer[chIdx][k], RealBuffer_local[chIdx][k], CLDFB_NO_CHANNELS_MAX );
1335 396067984 : mvr2r( ImagBuffer[chIdx][k], ImagBuffer_local[chIdx][k], CLDFB_NO_CHANNELS_MAX );
1336 : }
1337 : }
1338 :
1339 : /* Head rotation in HOA3 or CICPx */
1340 6949737 : if ( hCombinedOrientationData != NULL && hCombinedOrientationData->enableCombinedOrientation[hCombinedOrientationData->subframe_idx] && hBinRenderer->rotInCldfb )
1341 : {
1342 2855014 : if ( hBinRenderer->hInputSetup->is_loudspeaker_setup == 0 )
1343 : {
1344 : /* Rotation in SHD (HOA3) */
1345 2627798 : if ( hCombinedOrientationData->shd_rot_max_order == -1 )
1346 : {
1347 1119616 : rotateFrame_shd_cldfb( RealBuffer, ImagBuffer, hCombinedOrientationData->Rmat[hCombinedOrientationData->subframe_idx], hBinRenderer->hInputSetup->nchan_out_woLFE, numTimeSlots, 3 );
1348 : }
1349 1508182 : else if ( hCombinedOrientationData->shd_rot_max_order > 0 )
1350 : {
1351 87938 : rotateFrame_shd_cldfb( RealBuffer, ImagBuffer, hCombinedOrientationData->Rmat[hCombinedOrientationData->subframe_idx], hBinRenderer->hInputSetup->nchan_out_woLFE, numTimeSlots, hCombinedOrientationData->shd_rot_max_order );
1352 : }
1353 : }
1354 : else
1355 : {
1356 : /* Rotation in SD (CICPx) */
1357 227216 : rotateFrame_sd_cldfb( hCombinedOrientationData->Rmat[hCombinedOrientationData->subframe_idx], RealBuffer, ImagBuffer, hBinRenderer->hInputSetup, hBinRenderer->hEFAPdata, numTimeSlots, hBinRenderer->conv_band );
1358 : }
1359 : }
1360 :
1361 : /* HOA decoding to CICP19 if needed*/
1362 6949737 : if ( hBinRenderer->hInputSetup->is_loudspeaker_setup == 0 &&
1363 5421481 : ( hBinRenderer->nInChannels != HOA3_CHANNELS && hBinRenderer->nInChannels != HOA2_CHANNELS && hBinRenderer->nInChannels != FOA_CHANNELS ) )
1364 : {
1365 871272 : ivas_sba2mc_cldfb( *( hBinRenderer->hInputSetup ), RealBuffer, ImagBuffer, hBinRenderer->nInChannels, hBinRenderer->conv_band, numTimeSlots, hBinRenderer->hoa_dec_mtx );
1366 : }
1367 :
1368 6949737 : ivas_binRenderer_filterModule( Cldfb_RealBuffer_Binaural[0], Cldfb_ImagBuffer_Binaural[0], RealBuffer, ImagBuffer, numTimeSlots, hBinRenderer, 0 );
1369 :
1370 6949737 : if ( pMultiBinPoseData != NULL )
1371 : {
1372 731543 : if ( pMultiBinPoseData->num_poses > 1 )
1373 : {
1374 : IVAS_QUATERNION Quaternions_rel, Quaternions_abs, *Quaternions_ref;
1375 : float Rmat_local[3][3];
1376 :
1377 477038 : if ( hCombinedOrientationData && hBinRenderer->rotInCldfb )
1378 : {
1379 477038 : Quaternions_ref = &hCombinedOrientationData->Quaternions[0];
1380 477038 : Quaternions_rel.w = -3.0f; /*euler*/
1381 477038 : Quaternions_abs.w = -3.0f;
1382 :
1383 477038 : if ( hCombinedOrientationData->shd_rot_max_order == 0 )
1384 : {
1385 : /*HOA signal already rotated by DirAC*/
1386 231170 : Quaternions_abs.x = 0.0f;
1387 231170 : Quaternions_abs.y = 0.0f;
1388 231170 : Quaternions_abs.z = 0.0f;
1389 : }
1390 : else
1391 : {
1392 : /*euler*/
1393 245868 : Quat2EulerDegree( *Quaternions_ref, &Quaternions_abs.z, &Quaternions_abs.y, &Quaternions_abs.x ); /*order in Quat2Euler seems to be reversed ?*/
1394 : }
1395 :
1396 2422162 : for ( pos_idx = 1; pos_idx < pMultiBinPoseData->num_poses; pos_idx++ )
1397 : {
1398 33067108 : for ( chIdx = 0; chIdx < hBinRenderer->hInputSetup->nchan_out_woLFE; chIdx++ )
1399 : {
1400 151253056 : for ( k = 0; k < numTimeSlots; k++ )
1401 : {
1402 120131072 : mvr2r( RealBuffer_local[chIdx][k], RealBuffer[chIdx][k], CLDFB_NO_CHANNELS_MAX );
1403 120131072 : mvr2r( ImagBuffer_local[chIdx][k], ImagBuffer[chIdx][k], CLDFB_NO_CHANNELS_MAX );
1404 : }
1405 : }
1406 1945124 : Quaternions_rel.x = pMultiBinPoseData->relative_head_poses[pos_idx][0] - pMultiBinPoseData->relative_head_poses[pos_idx - 1][0];
1407 1945124 : Quaternions_rel.y = pMultiBinPoseData->relative_head_poses[pos_idx][1] - pMultiBinPoseData->relative_head_poses[pos_idx - 1][1];
1408 1945124 : Quaternions_rel.z = pMultiBinPoseData->relative_head_poses[pos_idx][2] - pMultiBinPoseData->relative_head_poses[pos_idx - 1][2];
1409 1945124 : Quaternions_abs.x = Quaternions_abs.x + Quaternions_rel.x;
1410 1945124 : Quaternions_abs.y = Quaternions_abs.y + Quaternions_rel.y;
1411 1945124 : Quaternions_abs.z = Quaternions_abs.z + Quaternions_rel.z;
1412 :
1413 1945124 : QuatToRotMat( Quaternions_abs, Rmat_local );
1414 :
1415 1945124 : if ( hBinRenderer->hInputSetup->is_loudspeaker_setup )
1416 : {
1417 0 : rotateFrame_sd_cldfb( Rmat_local, RealBuffer, ImagBuffer, hBinRenderer->hInputSetup, hBinRenderer->hEFAPdata, numTimeSlots, hBinRenderer->conv_band );
1418 : }
1419 : else
1420 : {
1421 1945124 : rotateFrame_shd_cldfb( RealBuffer, ImagBuffer, Rmat_local, hBinRenderer->hInputSetup->nchan_out_woLFE, numTimeSlots, hBinRenderer->hInputSetup->ambisonics_order );
1422 : }
1423 :
1424 1945124 : ivas_binRenderer_filterModule( Cldfb_RealBuffer_Binaural[pos_idx], Cldfb_ImagBuffer_Binaural[pos_idx], RealBuffer, ImagBuffer, numTimeSlots, hBinRenderer, pos_idx );
1425 : }
1426 : }
1427 : }
1428 : }
1429 :
1430 : /* Obtain the binaural dmx and compute the reverb */
1431 6949737 : if ( hBinRenderer->hReverb != NULL )
1432 : {
1433 : float reverbRe[BINAURAL_CHANNELS][CLDFB_SLOTS_PER_SUBFRAME][CLDFB_NO_CHANNELS_MAX];
1434 : float reverbIm[BINAURAL_CHANNELS][CLDFB_SLOTS_PER_SUBFRAME][CLDFB_NO_CHANNELS_MAX];
1435 : float inRe[BINAURAL_CHANNELS][CLDFB_SLOTS_PER_SUBFRAME][CLDFB_NO_CHANNELS_MAX];
1436 : float inIm[BINAURAL_CHANNELS][CLDFB_SLOTS_PER_SUBFRAME][CLDFB_NO_CHANNELS_MAX];
1437 :
1438 3957994 : ivas_binaural_obtain_DMX( numTimeSlots, hBinRenderer, RealBuffer, ImagBuffer, inRe, inIm );
1439 :
1440 11873982 : for ( chIdx = 0; chIdx < BINAURAL_CHANNELS; chIdx++ )
1441 : {
1442 39501302 : for ( k = 0; k < numTimeSlots; k++ )
1443 : {
1444 31585314 : set_zero( reverbRe[chIdx][k], hBinRenderer->max_band );
1445 31585314 : set_zero( reverbIm[chIdx][k], hBinRenderer->max_band );
1446 : }
1447 : }
1448 :
1449 3957994 : ivas_binaural_reverb_processSubframe( hBinRenderer->hReverb, BINAURAL_CHANNELS, numTimeSlots, inRe, inIm, reverbRe, reverbIm );
1450 :
1451 : /* Add the conv module and reverb module output */
1452 11873982 : for ( chIdx = 0; chIdx < BINAURAL_CHANNELS; chIdx++ )
1453 : {
1454 39501302 : for ( k = 0; k < numTimeSlots; k++ )
1455 : {
1456 63170628 : for ( pos_idx = 0; pos_idx < num_poses; pos_idx++ )
1457 : {
1458 : /* Combine first and second parts to generate binaural output signal with room effect */
1459 31585314 : v_add( Cldfb_RealBuffer_Binaural[pos_idx][chIdx][k], reverbRe[chIdx][k], Cldfb_RealBuffer_Binaural[pos_idx][chIdx][k], hBinRenderer->conv_band );
1460 31585314 : v_add( Cldfb_ImagBuffer_Binaural[pos_idx][chIdx][k], reverbIm[chIdx][k], Cldfb_ImagBuffer_Binaural[pos_idx][chIdx][k], hBinRenderer->conv_band );
1461 : }
1462 : }
1463 : }
1464 : }
1465 :
1466 6949737 : pop_wmops();
1467 6949737 : return;
1468 : }
1469 :
1470 :
1471 : /*-------------------------------------------------------------------------
1472 : * ivas_rend_CldfbMultiBinRendProcess()
1473 : *
1474 : *
1475 : *-------------------------------------------------------------------------*/
1476 :
1477 1248 : void ivas_rend_CldfbMultiBinRendProcess(
1478 : const BINAURAL_RENDERER_HANDLE hCldfbRend,
1479 : const COMBINED_ORIENTATION_HANDLE *pCombinedOrientationData,
1480 : const MULTI_BIN_REND_POSE_DATA *pMultiBinPoseData,
1481 : float Cldfb_In_Real[][CLDFB_NO_COL_MAX][CLDFB_NO_CHANNELS_MAX],
1482 : float Cldfb_In_Imag[][CLDFB_NO_COL_MAX][CLDFB_NO_CHANNELS_MAX],
1483 : float Cldfb_Out_Real[MAX_HEAD_ROT_POSES * BINAURAL_CHANNELS][CLDFB_NO_COL_MAX][CLDFB_NO_CHANNELS_MAX], /* o : Binaural signals */
1484 : float Cldfb_Out_Imag[MAX_HEAD_ROT_POSES * BINAURAL_CHANNELS][CLDFB_NO_COL_MAX][CLDFB_NO_CHANNELS_MAX],
1485 : const int16_t low_res_pre_rend_rot,
1486 : const int16_t num_subframes )
1487 : {
1488 : int16_t slot_idx, ch_idx, idx, pose_idx, i, j;
1489 : int16_t sf_idx;
1490 : float Cldfb_RealBuffer_sfIn[MAX_INPUT_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX];
1491 : float Cldfb_ImagBuffer_sfIn[MAX_INPUT_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX];
1492 : #ifdef SPLIT_REND_WITH_HEAD_ROT_DEBUG
1493 : HEAD_TRACK_DATA head_track_post;
1494 : float Cldfb_RealBuffer_Binaural[MAX_HEAD_ROT_POSES + 1][BINAURAL_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX];
1495 : float Cldfb_ImagBuffer_Binaural[MAX_HEAD_ROT_POSES + 1][BINAURAL_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX];
1496 : #else
1497 : float Cldfb_RealBuffer_Binaural[MAX_HEAD_ROT_POSES][BINAURAL_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX];
1498 : float Cldfb_ImagBuffer_Binaural[MAX_HEAD_ROT_POSES][BINAURAL_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX];
1499 : #endif
1500 :
1501 6240 : for ( sf_idx = 0; sf_idx < num_subframes; sf_idx++ )
1502 : {
1503 24960 : for ( slot_idx = 0; slot_idx < MAX_PARAM_SPATIAL_SUBFRAMES; slot_idx++ )
1504 : {
1505 19968 : idx = sf_idx * MAX_PARAM_SPATIAL_SUBFRAMES + slot_idx;
1506 339456 : for ( ch_idx = 0; ch_idx < hCldfbRend->nInChannels; ch_idx++ )
1507 : {
1508 319488 : mvr2r( &Cldfb_In_Real[ch_idx][idx][0], &Cldfb_RealBuffer_sfIn[ch_idx][slot_idx][0], hCldfbRend->max_band );
1509 319488 : mvr2r( &Cldfb_In_Imag[ch_idx][idx][0], &Cldfb_ImagBuffer_sfIn[ch_idx][slot_idx][0], hCldfbRend->max_band );
1510 : }
1511 : }
1512 :
1513 4992 : if ( ( *pCombinedOrientationData ) != NULL )
1514 : {
1515 4992 : if ( ( low_res_pre_rend_rot ) && ( pMultiBinPoseData->poseCorrectionMode == ISAR_SPLIT_REND_POSE_CORRECTION_MODE_CLDFB ) )
1516 : {
1517 4992 : ( *pCombinedOrientationData )->Quaternions[sf_idx] = ( *pCombinedOrientationData )->Quaternions[0];
1518 19968 : for ( i = 0; i < 3; i++ )
1519 : {
1520 59904 : for ( j = 0; j < 3; j++ )
1521 : {
1522 44928 : ( *pCombinedOrientationData )->Rmat[sf_idx][i][j] = ( *pCombinedOrientationData )->Rmat[0][i][j];
1523 : }
1524 : }
1525 : }
1526 4992 : ( *pCombinedOrientationData )->shd_rot_max_order = -1;
1527 : }
1528 :
1529 : #ifdef SPLIT_REND_WITH_HEAD_ROT_DEBUG
1530 : head_track_post.num_quaternions = 0;
1531 : head_track_post.shd_rot_max_order = -1;
1532 : head_track_post.Quaternions[0] = ivas_split_rend_get_sf_rot_data( pHeadRotData->headPositionsPostRend, sf_idx );
1533 :
1534 : #endif
1535 : #ifdef SPLIT_REND_WITH_HEAD_ROT_DEBUG
1536 : ivas_binRenderer( hCldfbRend, pMultiBinPoseData, *pCombinedOrientationData, MAX_PARAM_SPATIAL_SUBFRAMES, &head_track_post, Cldfb_RealBuffer_Binaural, Cldfb_ImagBuffer_Binaural, Cldfb_RealBuffer_sfIn, Cldfb_ImagBuffer_sfIn );
1537 : #else
1538 4992 : ivas_binRenderer( hCldfbRend, pMultiBinPoseData, *pCombinedOrientationData, MAX_PARAM_SPATIAL_SUBFRAMES, Cldfb_RealBuffer_Binaural, Cldfb_ImagBuffer_Binaural, Cldfb_RealBuffer_sfIn, Cldfb_ImagBuffer_sfIn );
1539 : #endif
1540 :
1541 29952 : for ( pose_idx = 0; pose_idx < hCldfbRend->numPoses; pose_idx++ )
1542 : {
1543 124800 : for ( slot_idx = 0; slot_idx < MAX_PARAM_SPATIAL_SUBFRAMES; slot_idx++ )
1544 : {
1545 99840 : idx = sf_idx * MAX_PARAM_SPATIAL_SUBFRAMES + slot_idx;
1546 299520 : for ( ch_idx = 0; ch_idx < BINAURAL_CHANNELS; ch_idx++ )
1547 : {
1548 199680 : mvr2r( &Cldfb_RealBuffer_Binaural[pose_idx][ch_idx][slot_idx][0], &Cldfb_Out_Real[( pose_idx * BINAURAL_CHANNELS ) + ch_idx][idx][0], hCldfbRend->max_band );
1549 199680 : mvr2r( &Cldfb_ImagBuffer_Binaural[pose_idx][ch_idx][slot_idx][0], &Cldfb_Out_Imag[( pose_idx * BINAURAL_CHANNELS ) + ch_idx][idx][0], hCldfbRend->max_band );
1550 : }
1551 : }
1552 : }
1553 : }
1554 :
1555 1248 : return;
1556 : }
|
