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 4370880 : 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 202047330 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
83 : {
84 2840229450 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
85 : {
86 2642553000 : filterStatesLeftRealPtr = (float *) &( hBinRenderer->hBinRenConvModule->filterStatesLeftReal[pos_idx][bandIdx][chIdx][0] );
87 2642553000 : filterStatesLeftImagPtr = (float *) &( hBinRenderer->hBinRenConvModule->filterStatesLeftImag[pos_idx][bandIdx][chIdx][0] );
88 :
89 2642553000 : filterTapsLeftRealPtr = hBinRenderer->hBinRenConvModule->filterTapsLeftReal[bandIdx][chIdx];
90 2642553000 : filterTapsLeftImagPtr = hBinRenderer->hBinRenConvModule->filterTapsLeftImag[bandIdx][chIdx];
91 2642553000 : filterTapsRightRealPtr = hBinRenderer->hBinRenConvModule->filterTapsRightReal[bandIdx][chIdx];
92 2642553000 : filterTapsRightImagPtr = hBinRenderer->hBinRenConvModule->filterTapsRightImag[bandIdx][chIdx];
93 :
94 13172907240 : for ( k = 0; k < numTimeSlots; k++ )
95 : {
96 10530354240 : float outRealLeft = 0.0f, outRealRight = 0.0f, outImagLeft = 0.0f, outImagRight = 0.0f;
97 :
98 >13093*10^7 : for ( tapIdx = hBinRenderer->hBinRenConvModule->numTapsArray[bandIdx] - 1; tapIdx > 0; tapIdx-- )
99 : {
100 >12040*10^7 : filterStatesLeftRealPtr[tapIdx] = filterStatesLeftRealPtr[tapIdx - 1];
101 >12040*10^7 : filterStatesLeftImagPtr[tapIdx] = filterStatesLeftImagPtr[tapIdx - 1];
102 :
103 : /* Left Real and Imag */
104 >12040*10^7 : outRealLeft += ( filterStatesLeftRealPtr[tapIdx] * filterTapsLeftRealPtr[tapIdx] ) - ( filterStatesLeftImagPtr[tapIdx] * filterTapsLeftImagPtr[tapIdx] );
105 >12040*10^7 : outImagLeft += ( filterStatesLeftRealPtr[tapIdx] * filterTapsLeftImagPtr[tapIdx] ) + ( filterStatesLeftImagPtr[tapIdx] * filterTapsLeftRealPtr[tapIdx] );
106 :
107 : /* Right Real and Imag*/
108 >12040*10^7 : outRealRight += ( filterStatesLeftRealPtr[tapIdx] * filterTapsRightRealPtr[tapIdx] ) - ( filterStatesLeftImagPtr[tapIdx] * filterTapsRightImagPtr[tapIdx] );
109 >12040*10^7 : outImagRight += ( filterStatesLeftRealPtr[tapIdx] * filterTapsRightImagPtr[tapIdx] ) + ( filterStatesLeftImagPtr[tapIdx] * filterTapsRightRealPtr[tapIdx] );
110 : }
111 :
112 10530354240 : filterStatesLeftRealPtr[0] = CLDFB_real[chIdx][k][bandIdx];
113 10530354240 : filterStatesLeftImagPtr[0] = CLDFB_imag[chIdx][k][bandIdx];
114 :
115 :
116 : /* Left Real and Imag */
117 10530354240 : out_Conv_CLDFB_real[0][k][bandIdx] += outRealLeft + ( filterStatesLeftRealPtr[0] * filterTapsLeftRealPtr[0] ) - ( filterStatesLeftImagPtr[0] * filterTapsLeftImagPtr[0] );
118 10530354240 : out_Conv_CLDFB_imag[0][k][bandIdx] += outImagLeft + ( filterStatesLeftRealPtr[0] * filterTapsLeftImagPtr[0] ) + ( filterStatesLeftImagPtr[0] * filterTapsLeftRealPtr[0] );
119 :
120 : /* Right Real and Imag */
121 10530354240 : out_Conv_CLDFB_real[1][k][bandIdx] += outRealRight + ( filterStatesLeftRealPtr[0] * filterTapsRightRealPtr[0] ) - ( filterStatesLeftImagPtr[0] * filterTapsRightImagPtr[0] );
122 10530354240 : out_Conv_CLDFB_imag[1][k][bandIdx] += outImagRight + ( filterStatesLeftRealPtr[0] * filterTapsRightImagPtr[0] ) + ( filterStatesLeftImagPtr[0] * filterTapsRightRealPtr[0] );
123 : }
124 : }
125 : }
126 :
127 4370880 : return;
128 : }
129 :
130 :
131 : /*-------------------------------------------------------------------------
132 : * ivas_binRenderer_convModuleOpen()
133 : *
134 : * Open convolution module handle of fastconv binaural renderer
135 : *-------------------------------------------------------------------------*/
136 :
137 10035 : 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 10035 : 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 10035 : if ( !isLoudspeaker )
159 : {
160 5478 : hBinRenderer->nInChannels = audioCfg2channels( input_config );
161 : }
162 : else
163 : {
164 : /* Note: needs to be revisited if multiple LFE support is required */
165 4557 : hBinRenderer->nInChannels = ( audioCfg2channels( input_config ) - isLoudspeaker );
166 : }
167 :
168 10035 : hBinRenConvModule->numTaps = hHrtf->ntaps;
169 :
170 10035 : if ( renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM )
171 : {
172 : /* Use variable order filtering */
173 1788 : bandIdx = 0;
174 10728 : for ( ; bandIdx < 5; bandIdx++ )
175 : {
176 8940 : hBinRenConvModule->numTapsArray[bandIdx] = hBinRenConvModule->numTaps;
177 : }
178 10728 : for ( ; bandIdx < 10; bandIdx++ )
179 : {
180 8940 : hBinRenConvModule->numTapsArray[bandIdx] = (int16_t) ceilf( 0.6f * hBinRenConvModule->numTaps );
181 : }
182 19668 : for ( ; bandIdx < 20; bandIdx++ )
183 : {
184 17880 : hBinRenConvModule->numTapsArray[bandIdx] = (int16_t) ceilf( 0.5f * hBinRenConvModule->numTaps );
185 : }
186 19668 : for ( ; bandIdx < 30; bandIdx++ )
187 : {
188 17880 : hBinRenConvModule->numTapsArray[bandIdx] = (int16_t) ceilf( 0.4f * hBinRenConvModule->numTaps );
189 : }
190 28458 : for ( ; bandIdx < hBinRenderer->conv_band; bandIdx++ )
191 : {
192 26670 : hBinRenConvModule->numTapsArray[bandIdx] = (int16_t) ceilf( 0.3f * hBinRenConvModule->numTaps );
193 : }
194 : }
195 : else
196 : {
197 : /* Use fixed order filtering */
198 8247 : bandIdx = 0;
199 350007 : for ( ; bandIdx < hBinRenderer->conv_band; bandIdx++ )
200 : {
201 341760 : hBinRenConvModule->numTapsArray[bandIdx] = hBinRenConvModule->numTaps;
202 : }
203 : }
204 :
205 : /* allocate memory for filter states */
206 10035 : 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 10035 : 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 10035 : 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 10035 : 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 427665 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
227 : {
228 417630 : 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 417630 : 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 417630 : 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 417630 : 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 10035 : 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 10035 : 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 20070 : for ( pos_idx = 0; pos_idx < num_poses; pos_idx++ )
260 : {
261 10035 : 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 10035 : 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 427665 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
272 : {
273 417630 : 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 417630 : 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 5494440 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
284 : {
285 5076810 : 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 5076810 : 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 427665 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
300 : {
301 5494440 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
302 : {
303 5076810 : int16_t tmp = 0;
304 :
305 5076810 : tmp = chIdx;
306 5076810 : if ( isLoudspeaker )
307 : {
308 1197450 : if ( input_config == IVAS_AUDIO_CONFIG_5_1 )
309 : {
310 578250 : tmp = channelIndex_CICP6[chIdx];
311 : }
312 619200 : else if ( input_config == IVAS_AUDIO_CONFIG_7_1 )
313 : {
314 0 : tmp = channelIndex_CICP12[chIdx];
315 : }
316 619200 : else if ( input_config == IVAS_AUDIO_CONFIG_5_1_2 )
317 : {
318 62160 : tmp = channelIndex_CICP14[chIdx];
319 : }
320 557040 : else if ( input_config == IVAS_AUDIO_CONFIG_5_1_4 )
321 : {
322 0 : tmp = channelIndex_CICP16[chIdx];
323 : }
324 557040 : else if ( input_config == IVAS_AUDIO_CONFIG_7_1_4 )
325 : {
326 557040 : 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 5076810 : hBinRenConvModule->filterTapsLeftReal[bandIdx][chIdx] = hHrtf->leftReal[bandIdx][tmp];
337 5076810 : hBinRenConvModule->filterTapsLeftImag[bandIdx][chIdx] = hHrtf->leftImag[bandIdx][tmp];
338 5076810 : hBinRenConvModule->filterTapsRightReal[bandIdx][chIdx] = hHrtf->rightReal[bandIdx][tmp];
339 5076810 : hBinRenConvModule->filterTapsRightImag[bandIdx][chIdx] = hHrtf->rightImag[bandIdx][tmp];
340 : }
341 : }
342 :
343 20070 : for ( pos_idx = 0; pos_idx < num_poses; pos_idx++ )
344 : {
345 427665 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
346 : {
347 5494440 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
348 : {
349 : /* set the memories to zero */
350 5076810 : set_zero( hBinRenConvModule->filterStatesLeftReal[pos_idx][bandIdx][chIdx], hBinRenConvModule->numTapsArray[bandIdx] );
351 5076810 : set_zero( hBinRenConvModule->filterStatesLeftImag[pos_idx][bandIdx][chIdx], hBinRenConvModule->numTapsArray[bandIdx] );
352 : }
353 : }
354 : }
355 :
356 10035 : hBinRenderer->hBinRenConvModule = hBinRenConvModule;
357 :
358 10035 : return IVAS_ERR_OK;
359 : }
360 :
361 :
362 : /*-------------------------------------------------------------------------*
363 : * ivas_init_binaural_hrtf()
364 : *
365 : * initialize memory for HrtfFastConv structure elements
366 : *-------------------------------------------------------------------------*/
367 :
368 2829 : void ivas_init_binaural_hrtf(
369 : HRTFS_FASTCONV *HrtfFastConv /* i/o: FASTCONV HRTF structure */
370 : )
371 : {
372 : int16_t i;
373 :
374 2829 : HrtfFastConv->leftReal = NULL;
375 2829 : HrtfFastConv->leftImag = NULL;
376 2829 : HrtfFastConv->rightReal = NULL;
377 2829 : HrtfFastConv->rightImag = NULL;
378 2829 : HrtfFastConv->FASTCONV_latency_s = 0x00;
379 :
380 2829 : HrtfFastConv->n_channels = 0;
381 2829 : HrtfFastConv->allocate_init_flag = 0x00;
382 2829 : HrtfFastConv->ntaps = 0;
383 :
384 172569 : for ( i = 0; i < CLDFB_NO_CHANNELS_MAX; i++ )
385 : {
386 169740 : HrtfFastConv->fastconvReverberationEneCorrections[i] = 0x00;
387 169740 : HrtfFastConv->fastconvReverberationEneCorrections[i] = 0x00;
388 : }
389 :
390 2829 : return;
391 : }
392 :
393 :
394 : /*-------------------------------------------------------------------------*
395 : * ivas_alloc_pppMem()
396 : *
397 : * Allocate memory for tripple pointer elements
398 : *-------------------------------------------------------------------------*/
399 :
400 11316 : 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 11316 : float ***localMem = NULL;
409 :
410 11316 : 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 577116 : for ( i = 0; i < dim1; i++ )
416 : {
417 565800 : 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 565800 : if ( allocate_init_flag == 0 )
422 : {
423 8942400 : for ( j = 0; j < dim2; j++ )
424 : {
425 8404800 : 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 11316 : *pppMem = localMem;
434 :
435 11316 : return IVAS_ERR_OK;
436 : }
437 :
438 :
439 : /*-------------------------------------------------------------------------*
440 : * ivas_allocate_binaural_hrtf()
441 : *
442 : * Allocate memory for HrtfFastConv structure elements
443 : *-------------------------------------------------------------------------*/
444 :
445 3021 : 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 3021 : HrtfFastConv->n_channels = n_channels;
452 :
453 3021 : if ( ( HrtfFastConv->leftReal != NULL ) && ( HrtfFastConv->leftImag != NULL ) && ( HrtfFastConv->rightReal != NULL ) && ( HrtfFastConv->rightImag != NULL ) )
454 : {
455 192 : return IVAS_ERR_OK;
456 : }
457 : else
458 : {
459 2829 : 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 2829 : 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 2829 : 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 2829 : 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 2829 : return IVAS_ERR_OK;
478 : }
479 :
480 :
481 : /*-------------------------------------------------------------------------*
482 : * ivas_binaural_hrtf_open()
483 : *
484 : *
485 : *-------------------------------------------------------------------------*/
486 :
487 10035 : 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 10035 : if ( hHrtfFastConv != NULL && *hHrtfFastConv != NULL )
498 : {
499 : /* Tables already loaded from file */
500 9894 : return IVAS_ERR_OK;
501 : }
502 : else
503 : {
504 : /* Initialise tables from ROM */
505 : HRTFS_FASTCONV *HrtfFastConv;
506 :
507 141 : 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 141 : ivas_init_binaural_hrtf( HrtfFastConv );
513 :
514 141 : if ( input_config == IVAS_AUDIO_CONFIG_BINAURAL || renderer_type == RENDERER_BINAURAL_FASTCONV )
515 : {
516 99 : HrtfFastConv->FASTCONV_latency_s = FASTCONV_HRIR_latency_s;
517 99 : HrtfFastConv->ntaps = BINAURAL_NTAPS;
518 : }
519 141 : 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 141 : if ( input_config == IVAS_AUDIO_CONFIG_HOA3 )
525 : {
526 105 : HrtfFastConv->FASTCONV_latency_s = FASTCONV_HOA3_latency_s;
527 105 : HrtfFastConv->ntaps = BINAURAL_NTAPS_SBA;
528 : }
529 141 : 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 141 : if ( input_config == IVAS_AUDIO_CONFIG_BINAURAL || renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM )
535 : {
536 42 : HrtfFastConv->FASTCONV_latency_s = FASTCONV_BRIR_latency_s;
537 42 : HrtfFastConv->ntaps = BINAURAL_NTAPS_MAX;
538 : }
539 :
540 141 : HrtfFastConv->allocate_init_flag = 1;
541 :
542 141 : n_channels = 0;
543 141 : if ( ( renderer_type == RENDERER_BINAURAL_FASTCONV || renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM ) && input_config != IVAS_AUDIO_CONFIG_INVALID )
544 : {
545 141 : n_channels = HRTF_LS_CHANNELS;
546 : }
547 :
548 141 : if ( renderer_type == RENDERER_BINAURAL_FASTCONV )
549 : {
550 99 : if ( input_config == IVAS_AUDIO_CONFIG_HOA3 )
551 : {
552 84 : n_channels = HOA3_CHANNELS;
553 : }
554 15 : else if ( input_config == IVAS_AUDIO_CONFIG_HOA2 )
555 : {
556 0 : n_channels = HOA2_CHANNELS;
557 : }
558 15 : else if ( input_config == IVAS_AUDIO_CONFIG_FOA )
559 : {
560 0 : n_channels = FOA_CHANNELS;
561 : }
562 : }
563 :
564 141 : if ( ( error = ivas_allocate_binaural_hrtf( HrtfFastConv, n_channels, HrtfFastConv->allocate_init_flag ) ) != IVAS_ERR_OK )
565 : {
566 0 : return error;
567 : }
568 :
569 7191 : for ( i = 0; i < BINAURAL_CONVBANDS; i++ )
570 : {
571 7050 : if ( renderer_type == RENDERER_BINAURAL_FASTCONV && HrtfFastConv->n_channels == HRTF_LS_CHANNELS )
572 : {
573 12000 : for ( j = 0; j < HRTF_LS_CHANNELS; j++ )
574 : {
575 11250 : HrtfFastConv->leftReal[i][j] = leftHRIRReal[i][j];
576 11250 : HrtfFastConv->leftImag[i][j] = leftHRIRImag[i][j];
577 11250 : HrtfFastConv->rightReal[i][j] = rightHRIRReal[i][j];
578 11250 : HrtfFastConv->rightImag[i][j] = rightHRIRImag[i][j];
579 : }
580 : }
581 6300 : else if ( renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM && HrtfFastConv->n_channels == HRTF_LS_CHANNELS )
582 : {
583 33600 : for ( j = 0; j < HRTF_LS_CHANNELS; j++ )
584 : {
585 31500 : HrtfFastConv->leftReal[i][j] = leftBRIRReal[i][j];
586 31500 : HrtfFastConv->leftImag[i][j] = leftBRIRImag[i][j];
587 31500 : HrtfFastConv->rightReal[i][j] = rightBRIRReal[i][j];
588 31500 : HrtfFastConv->rightImag[i][j] = rightBRIRImag[i][j];
589 : }
590 : }
591 :
592 7050 : if ( input_config == IVAS_AUDIO_CONFIG_HOA3 && HrtfFastConv->n_channels == HOA3_CHANNELS )
593 : {
594 71400 : for ( j = 0; j < HOA3_CHANNELS; j++ )
595 : {
596 67200 : HrtfFastConv->leftReal[i][j] = leftHRIRReal_HOA3[i][j];
597 67200 : HrtfFastConv->leftImag[i][j] = leftHRIRImag_HOA3[i][j];
598 67200 : HrtfFastConv->rightReal[i][j] = rightHRIRReal_HOA3[i][j];
599 67200 : 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 7050 : 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 7050 : 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 141 : mvr2r( fastconvReverberationTimes, HrtfFastConv->fastconvReverberationTimes, CLDFB_NO_CHANNELS_MAX );
629 141 : mvr2r( fastconvReverberationEneCorrections, HrtfFastConv->fastconvReverberationEneCorrections, CLDFB_NO_CHANNELS_MAX );
630 :
631 141 : *hHrtfFastConv = HrtfFastConv;
632 :
633 141 : return IVAS_ERR_OK;
634 : }
635 : }
636 :
637 :
638 : /*-------------------------------------------------------------------------*
639 : * ivas_binaural_obtain_DMX()
640 : *
641 : *
642 : *-------------------------------------------------------------------------*/
643 :
644 2744298 : 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 2744298 : 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 4333920 : for ( k = 0; k < numTimeSlots; k++ )
663 : {
664 10401408 : for ( chOutIdx = 0; chOutIdx < BINAURAL_CHANNELS; chOutIdx++ )
665 : {
666 6934272 : set_zero( realDMX[chOutIdx][k], CLDFB_NO_CHANNELS_MAX );
667 6934272 : set_zero( imagDMX[chOutIdx][k], CLDFB_NO_CHANNELS_MAX );
668 : }
669 : }
670 :
671 2600352 : for ( chOutIdx = 0; chOutIdx < BINAURAL_CHANNELS; chOutIdx++ )
672 : {
673 1733568 : set_zero( P_in, hBinRenderer->conv_band );
674 :
675 16304448 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
676 : {
677 14570880 : float dmxConst = dmxmtx_table[chOutIdx][chIdx];
678 :
679 701087520 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
680 : {
681 3432583200 : for ( k = 0; k < numTimeSlots; k++ )
682 : {
683 2746066560 : temp1 = RealBuffer[chIdx][k][bandIdx] * dmxConst;
684 2746066560 : temp2 = ImagBuffer[chIdx][k][bandIdx] * dmxConst;
685 2746066560 : realDMX[chOutIdx][k][bandIdx] += temp1;
686 2746066560 : imagDMX[chOutIdx][k][bandIdx] += temp2;
687 :
688 2746066560 : P_in[bandIdx] += temp1 * temp1 + temp2 * temp2;
689 : }
690 : }
691 : }
692 :
693 82972608 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
694 : {
695 81239040 : P_out = 0.f;
696 406195200 : for ( k = 0; k < numTimeSlots; k++ )
697 : {
698 324956160 : temp1 = realDMX[chOutIdx][k][bandIdx];
699 324956160 : temp2 = imagDMX[chOutIdx][k][bandIdx];
700 324956160 : P_out += temp1 * temp1 + temp2 * temp2;
701 : }
702 81239040 : factEQ = sqrtf( P_in[bandIdx] / ( P_out + 1e-20f ) );
703 81239040 : if ( ( factEQ <= 1e-20f ) || ( P_in[bandIdx] <= 1e-20f ) || ( P_out <= 1e-20f ) )
704 : {
705 877878 : factEQ = 1.0f;
706 : }
707 :
708 81239040 : factEQ = max( min( factEQ, 2.0f ), 0.5f );
709 406195200 : for ( k = 0; k < numTimeSlots; k++ )
710 : {
711 324956160 : realDMX[chOutIdx][k][bandIdx] *= factEQ;
712 324956160 : imagDMX[chOutIdx][k][bandIdx] *= factEQ;
713 : }
714 : }
715 : }
716 : }
717 1877514 : 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 9350655 : for ( k = 0; k < numTimeSlots; k++ )
724 : {
725 7473141 : outRealLeftPtr = realDMX[0][k];
726 7473141 : outImagLeftPtr = imagDMX[0][k];
727 7473141 : outRealRightPtr = realDMX[1][k];
728 7473141 : outImagRightPtr = imagDMX[1][k];
729 7473141 : set_zero( outRealLeftPtr, CLDFB_NO_CHANNELS_MAX );
730 7473141 : set_zero( outImagLeftPtr, CLDFB_NO_CHANNELS_MAX );
731 7473141 : set_zero( outRealRightPtr, CLDFB_NO_CHANNELS_MAX );
732 7473141 : set_zero( outImagRightPtr, CLDFB_NO_CHANNELS_MAX );
733 :
734 : /*Ambisonics input requires different processing*/
735 7473141 : if ( hBinRenderer->nInChannels == HOA3_CHANNELS )
736 : {
737 : float *inRealPtr_W, *inImagPtr_W;
738 : float *inRealPtr_Y, *inImagPtr_Y;
739 :
740 4762581 : inRealPtr_W = (float *) &( RealBuffer[0][k][0] );
741 4762581 : inImagPtr_W = (float *) &( ImagBuffer[0][k][0] );
742 :
743 4762581 : inRealPtr_Y = (float *) &( RealBuffer[1][k][0] );
744 4762581 : inImagPtr_Y = (float *) &( ImagBuffer[1][k][0] );
745 :
746 212600601 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
747 : {
748 207838020 : outRealLeftPtr[bandIdx] = inRealPtr_W[bandIdx] + inRealPtr_Y[bandIdx];
749 207838020 : outImagLeftPtr[bandIdx] = inImagPtr_W[bandIdx] + inImagPtr_Y[bandIdx];
750 :
751 207838020 : outRealRightPtr[bandIdx] = inRealPtr_W[bandIdx] - inRealPtr_Y[bandIdx];
752 207838020 : outImagRightPtr[bandIdx] = inImagPtr_W[bandIdx] - inImagPtr_Y[bandIdx];
753 : }
754 : }
755 : else
756 : {
757 32526720 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
758 : {
759 29816160 : float foa_const = hBinRenderer->hReverb->foa_enc[chIdx][1];
760 :
761 29816160 : inRealPtr = (float *) &( RealBuffer[chIdx][k][0] );
762 29816160 : inImagPtr = (float *) &( ImagBuffer[chIdx][k][0] );
763 :
764 1265695200 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
765 : {
766 1235879040 : outRealLeftPtr[bandIdx] += inRealPtr[bandIdx] * ( 1.f + foa_const );
767 1235879040 : outImagLeftPtr[bandIdx] += inImagPtr[bandIdx] * ( 1.f + foa_const );
768 :
769 1235879040 : outRealRightPtr[bandIdx] += inRealPtr[bandIdx] * ( 1.f - foa_const );
770 1235879040 : outImagRightPtr[bandIdx] += inImagPtr[bandIdx] * ( 1.f - foa_const );
771 : }
772 : }
773 : }
774 : }
775 : }
776 :
777 2744298 : return;
778 : }
779 :
780 :
781 : /*-------------------------------------------------------------------------
782 : * ivas_rend_openCldfbRend()
783 : *
784 : * Allocate and initialize CLDFB fast conv renderer handle
785 : *------------------------------------------------------------------------*/
786 :
787 0 : 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 0 : 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 0 : 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 0 : hBinRenderer->rotInCldfb = 1;
813 0 : hBinRenderer->ivas_format = SBA_FORMAT;
814 :
815 0 : hBinRenderer->max_band = (int16_t) ( ( BINAURAL_MAXBANDS * output_Fs ) / 48000 );
816 0 : convBand = hBinRenderer->max_band;
817 :
818 0 : hBinRenderer->timeSlots = MAX_PARAM_SPATIAL_SUBFRAMES; /* Corresponds to 5 msec sound to motion latency */
819 :
820 0 : if ( convBand > BINAURAL_CONVBANDS )
821 : {
822 0 : hBinRenderer->conv_band = BINAURAL_CONVBANDS;
823 : }
824 : else
825 : {
826 0 : hBinRenderer->conv_band = convBand;
827 : }
828 :
829 0 : ivas_output_init( hBinRenderer->hInputSetup, inConfig );
830 0 : if ( ( error = getAudioConfigNumChannels( inConfig, &hBinRenderer->hInputSetup->nchan_out_woLFE ) ) != IVAS_ERR_OK )
831 : {
832 0 : return error;
833 : }
834 :
835 0 : 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 0 : hBinRenderer->numPoses = pMultiBinPoseData->num_poses;
841 : #endif
842 : }
843 : else
844 : {
845 0 : hBinRenderer->numPoses = 1;
846 : }
847 :
848 : /* Load HRTF tables */
849 0 : 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 0 : 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 0 : pCldfbRend->binaural_latency_ns = (int32_t) ( pCldfbRend->hHrtfFastConv->FASTCONV_latency_s * 1000000000.f );
861 :
862 0 : hBinRenderer->hReverb = NULL;
863 0 : hBinRenderer->hEFAPdata = NULL;
864 :
865 0 : pCldfbRend->hCldfbRend = hBinRenderer;
866 :
867 0 : return IVAS_ERR_OK;
868 : }
869 :
870 :
871 : /*-------------------------------------------------------------------------
872 : * ivas_binRenderer_open()
873 : *
874 : * Open fastconv binaural renderer handle
875 : *-------------------------------------------------------------------------*/
876 :
877 10035 : 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 10035 : 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 10035 : hBinRenderer->hInputSetup = &st_ivas->hIntSetup;
896 :
897 : /* Define of head rotation has to be done in binRendeder in CLDFB*/
898 10035 : hBinRenderer->rotInCldfb = 0;
899 10035 : if ( st_ivas->ivas_format == MC_FORMAT || st_ivas->ivas_format == SBA_FORMAT || st_ivas->ivas_format == SBA_ISM_FORMAT )
900 : {
901 10035 : hBinRenderer->rotInCldfb = 1;
902 : }
903 :
904 10035 : 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 0 : hBinRenderer->numPoses = st_ivas->hSplitBinRend->splitrend.multiBinPoseData.num_poses;
910 : #endif
911 : }
912 : else
913 : {
914 10035 : 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 10035 : if ( st_ivas->hIntSetup.is_loudspeaker_setup )
920 : {
921 4536 : hBinRenderer->ivas_format = MC_FORMAT;
922 : }
923 : else
924 : {
925 5499 : hBinRenderer->ivas_format = SBA_FORMAT;
926 : }
927 10035 : hBinRenderer->max_band = (int16_t) ( ( BINAURAL_MAXBANDS * st_ivas->hDecoderConfig->output_Fs ) / 48000 );
928 10035 : convBand = hBinRenderer->max_band;
929 :
930 10035 : hBinRenderer->timeSlots = MAX_PARAM_SPATIAL_SUBFRAMES; /* Corresponds to 5 msec sound to motion latency */
931 :
932 10035 : if ( convBand > BINAURAL_CONVBANDS )
933 : {
934 6393 : hBinRenderer->conv_band = BINAURAL_CONVBANDS;
935 : }
936 : else
937 : {
938 3642 : hBinRenderer->conv_band = convBand;
939 : }
940 :
941 : /*LFE rendering switched off by default*/
942 10035 : hBinRenderer->render_lfe = 0;
943 :
944 10035 : if ( st_ivas->ivas_format != ISM_FORMAT && st_ivas->hIntSetup.is_loudspeaker_setup )
945 : {
946 4536 : hBinRenderer->render_lfe = 1;
947 : }
948 :
949 10035 : 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 10035 : 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 10035 : if ( st_ivas->renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM && ( st_ivas->hIntSetup.is_loudspeaker_setup == 0 ) )
961 21 : {
962 : IVAS_OUTPUT_SETUP out_setup;
963 :
964 : /* Allocate memories and buffers needed for convolutional module in CICP19 */
965 21 : 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 21 : ivas_output_init( &out_setup, IVAS_AUDIO_CONFIG_7_1_4 );
971 :
972 21 : if ( st_ivas->hoa_dec_mtx == NULL )
973 : {
974 21 : 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 21 : hBinRenderer->hoa_dec_mtx = st_ivas->hoa_dec_mtx;
981 21 : 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 10014 : 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 10014 : 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 10035 : 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 4857 : pRoomAcoustics = ( st_ivas->hOutSetup.output_config == IVAS_AUDIO_CONFIG_BINAURAL_ROOM_REVERB ) ? &( st_ivas->hRenderConfig->roomAcoustics ) : NULL;
998 :
999 4857 : if ( ( error = ivas_binaural_reverb_init( &( hBinRenderer->hReverb ),
1000 : st_ivas->hHrtfStatistics,
1001 4857 : hBinRenderer->conv_band,
1002 4857 : hBinRenderer->timeSlots,
1003 : pRoomAcoustics,
1004 4857 : st_ivas->hDecoderConfig->output_Fs,
1005 4857 : st_ivas->hHrtfFastConv->fastconvReverberationTimes,
1006 4857 : st_ivas->hHrtfFastConv->fastconvReverberationEneCorrections,
1007 : NULL ) ) != IVAS_ERR_OK )
1008 :
1009 : {
1010 0 : return error;
1011 : }
1012 : }
1013 : else
1014 : {
1015 5178 : hBinRenderer->hReverb = NULL;
1016 : }
1017 :
1018 10035 : hBinRenderer->hEFAPdata = NULL;
1019 :
1020 10035 : if ( hBinRenderer->hReverb != NULL && hBinRenderer->nInChannels != HOA3_CHANNELS )
1021 : {
1022 3099 : if ( hBinRenderer->hInputSetup->is_loudspeaker_setup == 0 )
1023 : {
1024 252 : for ( k = 0; k < 11; k++ )
1025 : {
1026 231 : 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 3078 : 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 6 : 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 6 : hBinRenderer->hEFAPdata = st_ivas->hEFAPdata;
1042 : }
1043 : }
1044 :
1045 : /* Copy the handles to main handle */
1046 10035 : st_ivas->hBinRenderer = hBinRenderer;
1047 :
1048 10035 : 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 10035 : 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 10035 : hBinRenConvModule = ( *hBinRenderer )->hBinRenConvModule;
1068 :
1069 10035 : if ( hBinRenConvModule == NULL )
1070 : {
1071 0 : return;
1072 : }
1073 :
1074 427665 : for ( bandIdx = 0; bandIdx < ( *hBinRenderer )->conv_band; bandIdx++ )
1075 : {
1076 417630 : free( hBinRenConvModule->filterTapsLeftReal[bandIdx] );
1077 417630 : hBinRenConvModule->filterTapsLeftReal[bandIdx] = NULL;
1078 :
1079 417630 : free( hBinRenConvModule->filterTapsLeftImag[bandIdx] );
1080 417630 : hBinRenConvModule->filterTapsLeftImag[bandIdx] = NULL;
1081 :
1082 417630 : free( hBinRenConvModule->filterTapsRightReal[bandIdx] );
1083 417630 : hBinRenConvModule->filterTapsRightReal[bandIdx] = NULL;
1084 :
1085 417630 : free( hBinRenConvModule->filterTapsRightImag[bandIdx] );
1086 417630 : hBinRenConvModule->filterTapsRightImag[bandIdx] = NULL;
1087 : }
1088 :
1089 10035 : free( hBinRenConvModule->filterTapsLeftReal );
1090 10035 : hBinRenConvModule->filterTapsLeftReal = NULL;
1091 :
1092 10035 : free( hBinRenConvModule->filterTapsLeftImag );
1093 10035 : hBinRenConvModule->filterTapsLeftImag = NULL;
1094 :
1095 10035 : free( hBinRenConvModule->filterTapsRightReal );
1096 10035 : hBinRenConvModule->filterTapsRightReal = NULL;
1097 :
1098 10035 : free( hBinRenConvModule->filterTapsRightImag );
1099 10035 : hBinRenConvModule->filterTapsRightImag = NULL;
1100 :
1101 20070 : for ( posIdx = 0; posIdx < num_poses; posIdx++ )
1102 : {
1103 427665 : for ( bandIdx = 0; bandIdx < ( *hBinRenderer )->conv_band; bandIdx++ )
1104 : {
1105 5494440 : for ( chIdx = 0; chIdx < ( *hBinRenderer )->nInChannels; chIdx++ )
1106 : {
1107 5076810 : free( hBinRenConvModule->filterStatesLeftReal[posIdx][bandIdx][chIdx] );
1108 5076810 : hBinRenConvModule->filterStatesLeftReal[posIdx][bandIdx][chIdx] = NULL;
1109 :
1110 5076810 : free( hBinRenConvModule->filterStatesLeftImag[posIdx][bandIdx][chIdx] );
1111 5076810 : hBinRenConvModule->filterStatesLeftImag[posIdx][bandIdx][chIdx] = NULL;
1112 : }
1113 :
1114 417630 : free( hBinRenConvModule->filterStatesLeftReal[posIdx][bandIdx] );
1115 417630 : hBinRenConvModule->filterStatesLeftReal[posIdx][bandIdx] = NULL;
1116 :
1117 417630 : free( hBinRenConvModule->filterStatesLeftImag[posIdx][bandIdx] );
1118 417630 : hBinRenConvModule->filterStatesLeftImag[posIdx][bandIdx] = NULL;
1119 : }
1120 :
1121 10035 : free( hBinRenConvModule->filterStatesLeftReal[posIdx] );
1122 10035 : hBinRenConvModule->filterStatesLeftReal[posIdx] = NULL;
1123 :
1124 10035 : free( hBinRenConvModule->filterStatesLeftImag[posIdx] );
1125 10035 : hBinRenConvModule->filterStatesLeftImag[posIdx] = NULL;
1126 : }
1127 10035 : free( hBinRenConvModule->filterStatesLeftReal );
1128 10035 : hBinRenConvModule->filterStatesLeftReal = NULL;
1129 :
1130 10035 : free( hBinRenConvModule->filterStatesLeftImag );
1131 10035 : hBinRenConvModule->filterStatesLeftImag = NULL;
1132 :
1133 10035 : free( ( *hBinRenderer )->hBinRenConvModule );
1134 10035 : ( *hBinRenderer )->hBinRenConvModule = NULL;
1135 :
1136 10035 : return;
1137 : }
1138 :
1139 :
1140 : /*-------------------------------------------------------------------------
1141 : * ivas_binRenderer_close()
1142 : *
1143 : * Close fastconv binaural renderer memories
1144 : *------------------------------------------------------------------------*/
1145 :
1146 11836 : void ivas_binRenderer_close(
1147 : BINAURAL_RENDERER_HANDLE *hBinRenderer /* i/o: fastconv binaural renderer handle */
1148 : )
1149 : {
1150 11836 : if ( hBinRenderer == NULL || *hBinRenderer == NULL )
1151 : {
1152 1801 : return;
1153 : }
1154 :
1155 10035 : if ( ( *hBinRenderer )->hBinRenConvModule != NULL )
1156 : {
1157 10035 : ivas_binRenderer_convModuleClose( hBinRenderer, ( *hBinRenderer )->numPoses );
1158 : }
1159 :
1160 10035 : if ( ( *hBinRenderer )->hReverb != NULL )
1161 : {
1162 4857 : ivas_binaural_reverb_close( &( ( *hBinRenderer )->hReverb ) );
1163 : }
1164 :
1165 10035 : free( *hBinRenderer );
1166 10035 : *hBinRenderer = NULL;
1167 :
1168 10035 : return;
1169 : }
1170 :
1171 :
1172 : /*-------------------------------------------------------------------------
1173 : * ivas_free_pppHrtfMem()
1174 : *
1175 : * Free fastconv binaural renderer hrtf memories
1176 : *------------------------------------------------------------------------*/
1177 :
1178 11316 : 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 11316 : if ( *ppppHRIR != NULL )
1186 : {
1187 577116 : for ( i = 0; i < BINAURAL_CONVBANDS; i++ )
1188 : {
1189 565800 : if ( alloc_init == 0 )
1190 : {
1191 8942400 : for ( j = 0; j < dim; j++ )
1192 : {
1193 8404800 : free( ( *ppppHRIR )[i][j] );
1194 8404800 : ( *ppppHRIR )[i][j] = NULL;
1195 : }
1196 : }
1197 565800 : free( ( *ppppHRIR )[i] );
1198 565800 : ( *ppppHRIR )[i] = NULL;
1199 : }
1200 11316 : free( *ppppHRIR );
1201 11316 : *ppppHRIR = NULL;
1202 : }
1203 :
1204 11316 : return;
1205 : }
1206 :
1207 :
1208 : /*-------------------------------------------------------------------------
1209 : * ivas_binaural_hrtf_close()
1210 : *
1211 : * Close fastconv binaural renderer hrtf memories
1212 : *------------------------------------------------------------------------*/
1213 :
1214 16504 : 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 16504 : if ( hHrtfFastConv == NULL || *hHrtfFastConv == NULL )
1222 : {
1223 13675 : return;
1224 : }
1225 :
1226 2829 : allocate_init_flag = ( *hHrtfFastConv )->allocate_init_flag;
1227 2829 : n_channels = ( *hHrtfFastConv )->n_channels;
1228 :
1229 2829 : ivas_free_pppHrtfMem( &( *hHrtfFastConv )->leftReal, n_channels, allocate_init_flag );
1230 2829 : ivas_free_pppHrtfMem( &( *hHrtfFastConv )->leftImag, n_channels, allocate_init_flag );
1231 2829 : ivas_free_pppHrtfMem( &( *hHrtfFastConv )->rightReal, n_channels, allocate_init_flag );
1232 2829 : ivas_free_pppHrtfMem( &( *hHrtfFastConv )->rightImag, n_channels, allocate_init_flag );
1233 :
1234 2829 : 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 1795364 : 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 1795364 : if ( st_ivas->hBinRenderer != NULL )
1256 : {
1257 62916 : render_lfe = st_ivas->hBinRenderer->render_lfe;
1258 : }
1259 : else
1260 : {
1261 1732448 : render_lfe = TRUE;
1262 : }
1263 :
1264 1795364 : if ( render_lfe )
1265 : {
1266 1795364 : if ( st_ivas->renderer_type == RENDERER_BINAURAL_OBJECTS_TD )
1267 : {
1268 281935 : gain = GAIN_LFE;
1269 : }
1270 : else
1271 : {
1272 1513429 : gain = ( ( st_ivas->hCrendWrapper != NULL ) && ( st_ivas->hCrendWrapper->hHrtfCrend != NULL ) ) ? st_ivas->hCrendWrapper->hHrtfCrend->gain_lfe : GAIN_LFE;
1273 : }
1274 :
1275 3515601 : for ( idx_lfe = 0; idx_lfe < st_ivas->hIntSetup.num_lfe; idx_lfe++ )
1276 : {
1277 1720237 : 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 1720237 : v_add( output_f[0], lfe_tc, output_f[0], output_frame );
1280 1720237 : v_add( output_f[1], lfe_tc, output_f[1], output_frame );
1281 : }
1282 : }
1283 :
1284 1795364 : return;
1285 : }
1286 :
1287 :
1288 : /*-------------------------------------------------------------------------
1289 : * ivas_binRenderer()
1290 : *
1291 : * Fastconv binaural renderer main function
1292 : *-------------------------------------------------------------------------*/
1293 :
1294 4370880 : 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 4370880 : push_wmops( "fastconv_binaural_rendering" );
1314 4370880 : num_poses = hBinRenderer->numPoses;
1315 :
1316 : /* Compute Convolution */
1317 : /* memory reset for the binaural output */
1318 8741760 : for ( pos_idx = 0; pos_idx < num_poses; pos_idx++ )
1319 : {
1320 13112640 : for ( chIdx = 0; chIdx < BINAURAL_CHANNELS; chIdx++ )
1321 : {
1322 43596504 : for ( k = 0; k < numTimeSlots; k++ )
1323 : {
1324 34854744 : set_zero( Cldfb_RealBuffer_Binaural[pos_idx][chIdx][k], CLDFB_NO_CHANNELS_MAX );
1325 34854744 : set_zero( Cldfb_ImagBuffer_Binaural[pos_idx][chIdx][k], CLDFB_NO_CHANNELS_MAX );
1326 : }
1327 : }
1328 : }
1329 :
1330 66258348 : for ( chIdx = 0; chIdx < hBinRenderer->hInputSetup->nchan_out_woLFE; chIdx++ )
1331 : {
1332 308538972 : for ( k = 0; k < numTimeSlots; k++ )
1333 : {
1334 246651504 : mvr2r( RealBuffer[chIdx][k], RealBuffer_local[chIdx][k], CLDFB_NO_CHANNELS_MAX );
1335 246651504 : mvr2r( ImagBuffer[chIdx][k], ImagBuffer_local[chIdx][k], CLDFB_NO_CHANNELS_MAX );
1336 : }
1337 : }
1338 :
1339 : /* Head rotation in HOA3 or CICPx */
1340 4370880 : if ( hCombinedOrientationData != NULL && hCombinedOrientationData->enableCombinedOrientation[hCombinedOrientationData->subframe_idx] && hBinRenderer->rotInCldfb )
1341 : {
1342 1865013 : if ( hBinRenderer->hInputSetup->is_loudspeaker_setup == 0 )
1343 : {
1344 : /* Rotation in SHD (HOA3) */
1345 1669797 : if ( hCombinedOrientationData->shd_rot_max_order == -1 )
1346 : {
1347 774477 : rotateFrame_shd_cldfb( RealBuffer, ImagBuffer, hCombinedOrientationData->Rmat[hCombinedOrientationData->subframe_idx], hBinRenderer->hInputSetup->nchan_out_woLFE, numTimeSlots, 3 );
1348 : }
1349 895320 : else if ( hCombinedOrientationData->shd_rot_max_order > 0 )
1350 : {
1351 9600 : 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 195216 : 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 4370880 : if ( hBinRenderer->hInputSetup->is_loudspeaker_setup == 0 &&
1363 3360348 : ( hBinRenderer->nInChannels != HOA3_CHANNELS && hBinRenderer->nInChannels != HOA2_CHANNELS && hBinRenderer->nInChannels != FOA_CHANNELS ) )
1364 : {
1365 677640 : ivas_sba2mc_cldfb( *( hBinRenderer->hInputSetup ), RealBuffer, ImagBuffer, hBinRenderer->nInChannels, hBinRenderer->conv_band, numTimeSlots, hBinRenderer->hoa_dec_mtx );
1366 : }
1367 :
1368 4370880 : ivas_binRenderer_filterModule( Cldfb_RealBuffer_Binaural[0], Cldfb_ImagBuffer_Binaural[0], RealBuffer, ImagBuffer, numTimeSlots, hBinRenderer, 0 );
1369 :
1370 4370880 : if ( pMultiBinPoseData != NULL )
1371 : {
1372 0 : if ( pMultiBinPoseData->num_poses > 1 )
1373 : {
1374 : IVAS_QUATERNION Quaternions_rel, Quaternions_abs, *Quaternions_ref;
1375 : float Rmat_local[3][3];
1376 :
1377 0 : if ( hCombinedOrientationData && hBinRenderer->rotInCldfb )
1378 : {
1379 0 : Quaternions_ref = &hCombinedOrientationData->Quaternions[0];
1380 0 : Quaternions_rel.w = -3.0f; /*euler*/
1381 0 : Quaternions_abs.w = -3.0f;
1382 :
1383 0 : if ( hCombinedOrientationData->shd_rot_max_order == 0 )
1384 : {
1385 : /*HOA signal already rotated by DirAC*/
1386 0 : Quaternions_abs.x = 0.0f;
1387 0 : Quaternions_abs.y = 0.0f;
1388 0 : Quaternions_abs.z = 0.0f;
1389 : }
1390 : else
1391 : {
1392 : /*euler*/
1393 0 : Quat2EulerDegree( *Quaternions_ref, &Quaternions_abs.z, &Quaternions_abs.y, &Quaternions_abs.x ); /*order in Quat2Euler seems to be reversed ?*/
1394 : }
1395 :
1396 0 : for ( pos_idx = 1; pos_idx < pMultiBinPoseData->num_poses; pos_idx++ )
1397 : {
1398 0 : for ( chIdx = 0; chIdx < hBinRenderer->hInputSetup->nchan_out_woLFE; chIdx++ )
1399 : {
1400 0 : for ( k = 0; k < numTimeSlots; k++ )
1401 : {
1402 0 : mvr2r( RealBuffer_local[chIdx][k], RealBuffer[chIdx][k], CLDFB_NO_CHANNELS_MAX );
1403 0 : mvr2r( ImagBuffer_local[chIdx][k], ImagBuffer[chIdx][k], CLDFB_NO_CHANNELS_MAX );
1404 : }
1405 : }
1406 0 : Quaternions_rel.x = pMultiBinPoseData->relative_head_poses[pos_idx][0] - pMultiBinPoseData->relative_head_poses[pos_idx - 1][0];
1407 0 : Quaternions_rel.y = pMultiBinPoseData->relative_head_poses[pos_idx][1] - pMultiBinPoseData->relative_head_poses[pos_idx - 1][1];
1408 0 : Quaternions_rel.z = pMultiBinPoseData->relative_head_poses[pos_idx][2] - pMultiBinPoseData->relative_head_poses[pos_idx - 1][2];
1409 0 : Quaternions_abs.x = Quaternions_abs.x + Quaternions_rel.x;
1410 0 : Quaternions_abs.y = Quaternions_abs.y + Quaternions_rel.y;
1411 0 : Quaternions_abs.z = Quaternions_abs.z + Quaternions_rel.z;
1412 :
1413 0 : QuatToRotMat( Quaternions_abs, Rmat_local );
1414 :
1415 0 : 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 0 : rotateFrame_shd_cldfb( RealBuffer, ImagBuffer, Rmat_local, hBinRenderer->hInputSetup->nchan_out_woLFE, numTimeSlots, hBinRenderer->hInputSetup->ambisonics_order );
1422 : }
1423 :
1424 0 : 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 4370880 : 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 2744298 : ivas_binaural_obtain_DMX( numTimeSlots, hBinRenderer, RealBuffer, ImagBuffer, inRe, inIm );
1439 :
1440 8232894 : for ( chIdx = 0; chIdx < BINAURAL_CHANNELS; chIdx++ )
1441 : {
1442 27369150 : for ( k = 0; k < numTimeSlots; k++ )
1443 : {
1444 21880554 : set_zero( reverbRe[chIdx][k], hBinRenderer->max_band );
1445 21880554 : set_zero( reverbIm[chIdx][k], hBinRenderer->max_band );
1446 : }
1447 : }
1448 :
1449 2744298 : ivas_binaural_reverb_processSubframe( hBinRenderer->hReverb, BINAURAL_CHANNELS, numTimeSlots, inRe, inIm, reverbRe, reverbIm );
1450 :
1451 : /* Add the conv module and reverb module output */
1452 8232894 : for ( chIdx = 0; chIdx < BINAURAL_CHANNELS; chIdx++ )
1453 : {
1454 27369150 : for ( k = 0; k < numTimeSlots; k++ )
1455 : {
1456 43761108 : 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 21880554 : v_add( Cldfb_RealBuffer_Binaural[pos_idx][chIdx][k], reverbRe[chIdx][k], Cldfb_RealBuffer_Binaural[pos_idx][chIdx][k], hBinRenderer->conv_band );
1460 21880554 : 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 4370880 : pop_wmops();
1467 4370880 : return;
1468 : }
1469 :
1470 :
1471 : /*-------------------------------------------------------------------------
1472 : * ivas_rend_CldfbMultiBinRendProcess()
1473 : *
1474 : *
1475 : *-------------------------------------------------------------------------*/
1476 :
1477 0 : 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 0 : for ( sf_idx = 0; sf_idx < num_subframes; sf_idx++ )
1502 : {
1503 0 : for ( slot_idx = 0; slot_idx < MAX_PARAM_SPATIAL_SUBFRAMES; slot_idx++ )
1504 : {
1505 0 : idx = sf_idx * MAX_PARAM_SPATIAL_SUBFRAMES + slot_idx;
1506 0 : for ( ch_idx = 0; ch_idx < hCldfbRend->nInChannels; ch_idx++ )
1507 : {
1508 0 : mvr2r( &Cldfb_In_Real[ch_idx][idx][0], &Cldfb_RealBuffer_sfIn[ch_idx][slot_idx][0], hCldfbRend->max_band );
1509 0 : mvr2r( &Cldfb_In_Imag[ch_idx][idx][0], &Cldfb_ImagBuffer_sfIn[ch_idx][slot_idx][0], hCldfbRend->max_band );
1510 : }
1511 : }
1512 :
1513 0 : if ( ( *pCombinedOrientationData ) != NULL )
1514 : {
1515 0 : if ( ( low_res_pre_rend_rot ) && ( pMultiBinPoseData->poseCorrectionMode == ISAR_SPLIT_REND_POSE_CORRECTION_MODE_CLDFB ) )
1516 : {
1517 0 : ( *pCombinedOrientationData )->Quaternions[sf_idx] = ( *pCombinedOrientationData )->Quaternions[0];
1518 0 : for ( i = 0; i < 3; i++ )
1519 : {
1520 0 : for ( j = 0; j < 3; j++ )
1521 : {
1522 0 : ( *pCombinedOrientationData )->Rmat[sf_idx][i][j] = ( *pCombinedOrientationData )->Rmat[0][i][j];
1523 : }
1524 : }
1525 : }
1526 0 : ( *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 0 : 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 0 : for ( pose_idx = 0; pose_idx < hCldfbRend->numPoses; pose_idx++ )
1542 : {
1543 0 : for ( slot_idx = 0; slot_idx < MAX_PARAM_SPATIAL_SUBFRAMES; slot_idx++ )
1544 : {
1545 0 : idx = sf_idx * MAX_PARAM_SPATIAL_SUBFRAMES + slot_idx;
1546 0 : for ( ch_idx = 0; ch_idx < BINAURAL_CHANNELS; ch_idx++ )
1547 : {
1548 0 : 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 0 : 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 0 : return;
1556 : }
|