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 3215877 : 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 146225997 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
83 : {
84 2275155720 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
85 : {
86 2132145600 : filterStatesLeftRealPtr = (float *) &( hBinRenderer->hBinRenConvModule->filterStatesLeftReal[pos_idx][bandIdx][chIdx][0] );
87 2132145600 : filterStatesLeftImagPtr = (float *) &( hBinRenderer->hBinRenConvModule->filterStatesLeftImag[pos_idx][bandIdx][chIdx][0] );
88 :
89 2132145600 : filterTapsLeftRealPtr = hBinRenderer->hBinRenConvModule->filterTapsLeftReal[bandIdx][chIdx];
90 2132145600 : filterTapsLeftImagPtr = hBinRenderer->hBinRenConvModule->filterTapsLeftImag[bandIdx][chIdx];
91 2132145600 : filterTapsRightRealPtr = hBinRenderer->hBinRenConvModule->filterTapsRightReal[bandIdx][chIdx];
92 2132145600 : filterTapsRightImagPtr = hBinRenderer->hBinRenConvModule->filterTapsRightImag[bandIdx][chIdx];
93 :
94 10496265280 : for ( k = 0; k < numTimeSlots; k++ )
95 : {
96 8364119680 : float outRealLeft = 0.0f, outRealRight = 0.0f, outImagLeft = 0.0f, outImagRight = 0.0f;
97 :
98 65834807040 : for ( tapIdx = hBinRenderer->hBinRenConvModule->numTapsArray[bandIdx] - 1; tapIdx > 0; tapIdx-- )
99 : {
100 57470687360 : filterStatesLeftRealPtr[tapIdx] = filterStatesLeftRealPtr[tapIdx - 1];
101 57470687360 : filterStatesLeftImagPtr[tapIdx] = filterStatesLeftImagPtr[tapIdx - 1];
102 :
103 : /* Left Real and Imag */
104 57470687360 : outRealLeft += ( filterStatesLeftRealPtr[tapIdx] * filterTapsLeftRealPtr[tapIdx] ) - ( filterStatesLeftImagPtr[tapIdx] * filterTapsLeftImagPtr[tapIdx] );
105 57470687360 : outImagLeft += ( filterStatesLeftRealPtr[tapIdx] * filterTapsLeftImagPtr[tapIdx] ) + ( filterStatesLeftImagPtr[tapIdx] * filterTapsLeftRealPtr[tapIdx] );
106 :
107 : /* Right Real and Imag*/
108 57470687360 : outRealRight += ( filterStatesLeftRealPtr[tapIdx] * filterTapsRightRealPtr[tapIdx] ) - ( filterStatesLeftImagPtr[tapIdx] * filterTapsRightImagPtr[tapIdx] );
109 57470687360 : outImagRight += ( filterStatesLeftRealPtr[tapIdx] * filterTapsRightImagPtr[tapIdx] ) + ( filterStatesLeftImagPtr[tapIdx] * filterTapsRightRealPtr[tapIdx] );
110 : }
111 :
112 8364119680 : filterStatesLeftRealPtr[0] = CLDFB_real[chIdx][k][bandIdx];
113 8364119680 : filterStatesLeftImagPtr[0] = CLDFB_imag[chIdx][k][bandIdx];
114 :
115 :
116 : /* Left Real and Imag */
117 8364119680 : out_Conv_CLDFB_real[0][k][bandIdx] += outRealLeft + ( filterStatesLeftRealPtr[0] * filterTapsLeftRealPtr[0] ) - ( filterStatesLeftImagPtr[0] * filterTapsLeftImagPtr[0] );
118 8364119680 : out_Conv_CLDFB_imag[0][k][bandIdx] += outImagLeft + ( filterStatesLeftRealPtr[0] * filterTapsLeftImagPtr[0] ) + ( filterStatesLeftImagPtr[0] * filterTapsLeftRealPtr[0] );
119 :
120 : /* Right Real and Imag */
121 8364119680 : out_Conv_CLDFB_real[1][k][bandIdx] += outRealRight + ( filterStatesLeftRealPtr[0] * filterTapsRightRealPtr[0] ) - ( filterStatesLeftImagPtr[0] * filterTapsRightImagPtr[0] );
122 8364119680 : out_Conv_CLDFB_imag[1][k][bandIdx] += outImagRight + ( filterStatesLeftRealPtr[0] * filterTapsRightImagPtr[0] ) + ( filterStatesLeftImagPtr[0] * filterTapsRightRealPtr[0] );
123 : }
124 : }
125 : }
126 :
127 3215877 : return;
128 : }
129 :
130 :
131 : /*-------------------------------------------------------------------------
132 : * ivas_binRenderer_convModuleOpen()
133 : *
134 : * Open convolution module handle of fastconv binaural renderer
135 : *-------------------------------------------------------------------------*/
136 :
137 8221 : 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 8221 : 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 8221 : if ( !isLoudspeaker )
159 : {
160 5246 : hBinRenderer->nInChannels = audioCfg2channels( input_config );
161 : }
162 : else
163 : {
164 : /* Note: needs to be revisited if multiple LFE support is required */
165 2975 : hBinRenderer->nInChannels = ( audioCfg2channels( input_config ) - isLoudspeaker );
166 : }
167 :
168 8221 : hBinRenConvModule->numTaps = hHrtf->ntaps;
169 :
170 8221 : if ( renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM )
171 : {
172 : /* Use variable order filtering */
173 2289 : bandIdx = 0;
174 13734 : for ( ; bandIdx < 5; bandIdx++ )
175 : {
176 11445 : hBinRenConvModule->numTapsArray[bandIdx] = hBinRenConvModule->numTaps;
177 : }
178 13734 : for ( ; bandIdx < 10; bandIdx++ )
179 : {
180 11445 : hBinRenConvModule->numTapsArray[bandIdx] = (int16_t) ceilf( 0.6f * hBinRenConvModule->numTaps );
181 : }
182 25179 : for ( ; bandIdx < 20; bandIdx++ )
183 : {
184 22890 : hBinRenConvModule->numTapsArray[bandIdx] = (int16_t) ceilf( 0.5f * hBinRenConvModule->numTaps );
185 : }
186 25179 : for ( ; bandIdx < 30; bandIdx++ )
187 : {
188 22890 : hBinRenConvModule->numTapsArray[bandIdx] = (int16_t) ceilf( 0.4f * hBinRenConvModule->numTaps );
189 : }
190 26889 : for ( ; bandIdx < hBinRenderer->conv_band; bandIdx++ )
191 : {
192 24600 : hBinRenConvModule->numTapsArray[bandIdx] = (int16_t) ceilf( 0.3f * hBinRenConvModule->numTaps );
193 : }
194 : }
195 : else
196 : {
197 : /* Use fixed order filtering */
198 5932 : bandIdx = 0;
199 238572 : for ( ; bandIdx < hBinRenderer->conv_band; bandIdx++ )
200 : {
201 232640 : hBinRenConvModule->numTapsArray[bandIdx] = hBinRenConvModule->numTaps;
202 : }
203 : }
204 :
205 : /* allocate memory for filter states */
206 8221 : 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 8221 : 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 8221 : 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 8221 : 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 327111 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
227 : {
228 318890 : 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 318890 : 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 318890 : 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 318890 : 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 8221 : 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 8221 : 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 18250 : for ( pos_idx = 0; pos_idx < num_poses; pos_idx++ )
260 : {
261 10029 : 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 10029 : 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 419319 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
272 : {
273 409290 : 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 409290 : 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 6203760 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
284 : {
285 5794470 : 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 5794470 : 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 327111 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
300 : {
301 4666960 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
302 : {
303 4348070 : int16_t tmp = 0;
304 :
305 4348070 : tmp = chIdx;
306 4348070 : if ( isLoudspeaker )
307 : {
308 1039270 : if ( input_config == IVAS_AUDIO_CONFIG_5_1 )
309 : {
310 130800 : tmp = channelIndex_CICP6[chIdx];
311 : }
312 908470 : else if ( input_config == IVAS_AUDIO_CONFIG_7_1 )
313 : {
314 27720 : tmp = channelIndex_CICP12[chIdx];
315 : }
316 880750 : else if ( input_config == IVAS_AUDIO_CONFIG_5_1_2 )
317 : {
318 29680 : tmp = channelIndex_CICP14[chIdx];
319 : }
320 851070 : else if ( input_config == IVAS_AUDIO_CONFIG_5_1_4 )
321 : {
322 17820 : tmp = channelIndex_CICP16[chIdx];
323 : }
324 833250 : else if ( input_config == IVAS_AUDIO_CONFIG_7_1_4 )
325 : {
326 833250 : 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 4348070 : hBinRenConvModule->filterTapsLeftReal[bandIdx][chIdx] = hHrtf->leftReal[bandIdx][tmp];
337 4348070 : hBinRenConvModule->filterTapsLeftImag[bandIdx][chIdx] = hHrtf->leftImag[bandIdx][tmp];
338 4348070 : hBinRenConvModule->filterTapsRightReal[bandIdx][chIdx] = hHrtf->rightReal[bandIdx][tmp];
339 4348070 : hBinRenConvModule->filterTapsRightImag[bandIdx][chIdx] = hHrtf->rightImag[bandIdx][tmp];
340 : }
341 : }
342 :
343 18250 : for ( pos_idx = 0; pos_idx < num_poses; pos_idx++ )
344 : {
345 419319 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
346 : {
347 6203760 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
348 : {
349 : /* set the memories to zero */
350 5794470 : set_zero( hBinRenConvModule->filterStatesLeftReal[pos_idx][bandIdx][chIdx], hBinRenConvModule->numTapsArray[bandIdx] );
351 5794470 : set_zero( hBinRenConvModule->filterStatesLeftImag[pos_idx][bandIdx][chIdx], hBinRenConvModule->numTapsArray[bandIdx] );
352 : }
353 : }
354 : }
355 :
356 8221 : hBinRenderer->hBinRenConvModule = hBinRenConvModule;
357 :
358 8221 : return IVAS_ERR_OK;
359 : }
360 :
361 :
362 : /*-------------------------------------------------------------------------*
363 : * ivas_init_binaural_hrtf()
364 : *
365 : * initialize memory for HrtfFastConv structure elements
366 : *-------------------------------------------------------------------------*/
367 :
368 7261 : void ivas_init_binaural_hrtf(
369 : HRTFS_FASTCONV *HrtfFastConv /* i/o: FASTCONV HRTF structure */
370 : )
371 : {
372 : int16_t i;
373 :
374 7261 : HrtfFastConv->leftReal = NULL;
375 7261 : HrtfFastConv->leftImag = NULL;
376 7261 : HrtfFastConv->rightReal = NULL;
377 7261 : HrtfFastConv->rightImag = NULL;
378 7261 : HrtfFastConv->FASTCONV_latency_s = 0x00;
379 :
380 7261 : HrtfFastConv->n_channels = 0;
381 7261 : HrtfFastConv->allocate_init_flag = 0x00;
382 7261 : HrtfFastConv->ntaps = 0;
383 :
384 442921 : for ( i = 0; i < CLDFB_NO_CHANNELS_MAX; i++ )
385 : {
386 435660 : HrtfFastConv->fastconvReverberationEneCorrections[i] = 0x00;
387 435660 : HrtfFastConv->fastconvReverberationEneCorrections[i] = 0x00;
388 : }
389 :
390 7261 : return;
391 : }
392 :
393 :
394 : /*-------------------------------------------------------------------------*
395 : * ivas_alloc_pppMem()
396 : *
397 : * Allocate memory for tripple pointer elements
398 : *-------------------------------------------------------------------------*/
399 :
400 29044 : 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 29044 : float ***localMem = NULL;
409 :
410 29044 : 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 1481244 : for ( i = 0; i < dim1; i++ )
416 : {
417 1452200 : 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 1452200 : if ( allocate_init_flag == 0 )
422 : {
423 7601400 : for ( j = 0; j < dim2; j++ )
424 : {
425 7144800 : 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 29044 : *pppMem = localMem;
434 :
435 29044 : return IVAS_ERR_OK;
436 : }
437 :
438 :
439 : /*-------------------------------------------------------------------------*
440 : * ivas_allocate_binaural_hrtf()
441 : *
442 : * Allocate memory for HrtfFastConv structure elements
443 : *-------------------------------------------------------------------------*/
444 :
445 7276 : 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 7276 : HrtfFastConv->n_channels = n_channels;
452 :
453 7276 : if ( ( HrtfFastConv->leftReal != NULL ) && ( HrtfFastConv->leftImag != NULL ) && ( HrtfFastConv->rightReal != NULL ) && ( HrtfFastConv->rightImag != NULL ) )
454 : {
455 15 : return IVAS_ERR_OK;
456 : }
457 : else
458 : {
459 7261 : 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 7261 : 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 7261 : 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 7261 : 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 7261 : return IVAS_ERR_OK;
478 : }
479 :
480 :
481 : /*-------------------------------------------------------------------------*
482 : * ivas_binaural_hrtf_open()
483 : *
484 : *
485 : *-------------------------------------------------------------------------*/
486 :
487 8221 : 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 8221 : if ( hHrtfFastConv != NULL && *hHrtfFastConv != NULL )
498 : {
499 : /* Tables already loaded from file */
500 3243 : return IVAS_ERR_OK;
501 : }
502 : else
503 : {
504 : /* Initialise tables from ROM */
505 : HRTFS_FASTCONV *HrtfFastConv;
506 :
507 4978 : 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 4978 : ivas_init_binaural_hrtf( HrtfFastConv );
513 :
514 4978 : if ( input_config == IVAS_AUDIO_CONFIG_BINAURAL || renderer_type == RENDERER_BINAURAL_FASTCONV )
515 : {
516 3550 : HrtfFastConv->FASTCONV_latency_s = FASTCONV_HRIR_latency_s;
517 3550 : HrtfFastConv->ntaps = BINAURAL_NTAPS;
518 : }
519 4978 : 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 4978 : if ( input_config == IVAS_AUDIO_CONFIG_HOA3 )
525 : {
526 3659 : HrtfFastConv->FASTCONV_latency_s = FASTCONV_HOA3_latency_s;
527 3659 : HrtfFastConv->ntaps = BINAURAL_NTAPS_SBA;
528 : }
529 4978 : 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 4978 : if ( input_config == IVAS_AUDIO_CONFIG_BINAURAL || renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM )
535 : {
536 1428 : HrtfFastConv->FASTCONV_latency_s = FASTCONV_BRIR_latency_s;
537 1428 : HrtfFastConv->ntaps = BINAURAL_NTAPS_MAX;
538 : }
539 :
540 4978 : HrtfFastConv->allocate_init_flag = 1;
541 :
542 4978 : n_channels = 0;
543 4978 : if ( ( renderer_type == RENDERER_BINAURAL_FASTCONV || renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM ) && input_config != IVAS_AUDIO_CONFIG_INVALID )
544 : {
545 4978 : n_channels = HRTF_LS_CHANNELS;
546 : }
547 :
548 4978 : if ( renderer_type == RENDERER_BINAURAL_FASTCONV )
549 : {
550 3550 : if ( input_config == IVAS_AUDIO_CONFIG_HOA3 )
551 : {
552 3350 : n_channels = HOA3_CHANNELS;
553 : }
554 200 : else if ( input_config == IVAS_AUDIO_CONFIG_HOA2 )
555 : {
556 0 : n_channels = HOA2_CHANNELS;
557 : }
558 200 : else if ( input_config == IVAS_AUDIO_CONFIG_FOA )
559 : {
560 0 : n_channels = FOA_CHANNELS;
561 : }
562 : }
563 :
564 4978 : if ( ( error = ivas_allocate_binaural_hrtf( HrtfFastConv, n_channels, HrtfFastConv->allocate_init_flag ) ) != IVAS_ERR_OK )
565 : {
566 0 : return error;
567 : }
568 :
569 253878 : for ( i = 0; i < BINAURAL_CONVBANDS; i++ )
570 : {
571 248900 : if ( renderer_type == RENDERER_BINAURAL_FASTCONV && HrtfFastConv->n_channels == HRTF_LS_CHANNELS )
572 : {
573 160000 : for ( j = 0; j < HRTF_LS_CHANNELS; j++ )
574 : {
575 150000 : HrtfFastConv->leftReal[i][j] = leftHRIRReal[i][j];
576 150000 : HrtfFastConv->leftImag[i][j] = leftHRIRImag[i][j];
577 150000 : HrtfFastConv->rightReal[i][j] = rightHRIRReal[i][j];
578 150000 : HrtfFastConv->rightImag[i][j] = rightHRIRImag[i][j];
579 : }
580 : }
581 238900 : else if ( renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM && HrtfFastConv->n_channels == HRTF_LS_CHANNELS )
582 : {
583 1142400 : for ( j = 0; j < HRTF_LS_CHANNELS; j++ )
584 : {
585 1071000 : HrtfFastConv->leftReal[i][j] = leftBRIRReal[i][j];
586 1071000 : HrtfFastConv->leftImag[i][j] = leftBRIRImag[i][j];
587 1071000 : HrtfFastConv->rightReal[i][j] = rightBRIRReal[i][j];
588 1071000 : HrtfFastConv->rightImag[i][j] = rightBRIRImag[i][j];
589 : }
590 : }
591 :
592 248900 : if ( input_config == IVAS_AUDIO_CONFIG_HOA3 && HrtfFastConv->n_channels == HOA3_CHANNELS )
593 : {
594 2847500 : for ( j = 0; j < HOA3_CHANNELS; j++ )
595 : {
596 2680000 : HrtfFastConv->leftReal[i][j] = leftHRIRReal_HOA3[i][j];
597 2680000 : HrtfFastConv->leftImag[i][j] = leftHRIRImag_HOA3[i][j];
598 2680000 : HrtfFastConv->rightReal[i][j] = rightHRIRReal_HOA3[i][j];
599 2680000 : 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 248900 : 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 248900 : 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 4978 : mvr2r( fastconvReverberationTimes, HrtfFastConv->fastconvReverberationTimes, CLDFB_NO_CHANNELS_MAX );
629 4978 : mvr2r( fastconvReverberationEneCorrections, HrtfFastConv->fastconvReverberationEneCorrections, CLDFB_NO_CHANNELS_MAX );
630 :
631 4978 : *hHrtfFastConv = HrtfFastConv;
632 :
633 4978 : return IVAS_ERR_OK;
634 : }
635 : }
636 :
637 :
638 : /*-------------------------------------------------------------------------*
639 : * ivas_binaural_obtain_DMX()
640 : *
641 : *
642 : *-------------------------------------------------------------------------*/
643 :
644 1108846 : 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 1108846 : 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 2158200 : for ( k = 0; k < numTimeSlots; k++ )
663 : {
664 5179680 : for ( chOutIdx = 0; chOutIdx < BINAURAL_CHANNELS; chOutIdx++ )
665 : {
666 3453120 : set_zero( realDMX[chOutIdx][k], CLDFB_NO_CHANNELS_MAX );
667 3453120 : set_zero( imagDMX[chOutIdx][k], CLDFB_NO_CHANNELS_MAX );
668 : }
669 : }
670 :
671 1294920 : for ( chOutIdx = 0; chOutIdx < BINAURAL_CHANNELS; chOutIdx++ )
672 : {
673 863280 : set_zero( P_in, hBinRenderer->conv_band );
674 :
675 9440352 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
676 : {
677 8577072 : float dmxConst = dmxmtx_table[chOutIdx][chIdx];
678 :
679 339617712 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
680 : {
681 1655203200 : for ( k = 0; k < numTimeSlots; k++ )
682 : {
683 1324162560 : temp1 = RealBuffer[chIdx][k][bandIdx] * dmxConst;
684 1324162560 : temp2 = ImagBuffer[chIdx][k][bandIdx] * dmxConst;
685 1324162560 : realDMX[chOutIdx][k][bandIdx] += temp1;
686 1324162560 : imagDMX[chOutIdx][k][bandIdx] += temp2;
687 :
688 1324162560 : P_in[bandIdx] += temp1 * temp1 + temp2 * temp2;
689 : }
690 : }
691 : }
692 :
693 34525680 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
694 : {
695 33662400 : P_out = 0.f;
696 168312000 : for ( k = 0; k < numTimeSlots; k++ )
697 : {
698 134649600 : temp1 = realDMX[chOutIdx][k][bandIdx];
699 134649600 : temp2 = imagDMX[chOutIdx][k][bandIdx];
700 134649600 : P_out += temp1 * temp1 + temp2 * temp2;
701 : }
702 33662400 : factEQ = sqrtf( P_in[bandIdx] / ( P_out + 1e-20f ) );
703 33662400 : if ( ( factEQ <= 1e-20f ) || ( P_in[bandIdx] <= 1e-20f ) || ( P_out <= 1e-20f ) )
704 : {
705 249972 : factEQ = 1.0f;
706 : }
707 :
708 33662400 : factEQ = max( min( factEQ, 2.0f ), 0.5f );
709 168312000 : for ( k = 0; k < numTimeSlots; k++ )
710 : {
711 134649600 : realDMX[chOutIdx][k][bandIdx] *= factEQ;
712 134649600 : imagDMX[chOutIdx][k][bandIdx] *= factEQ;
713 : }
714 : }
715 : }
716 : }
717 677206 : 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 3384227 : for ( k = 0; k < numTimeSlots; k++ )
724 : {
725 2707021 : outRealLeftPtr = realDMX[0][k];
726 2707021 : outImagLeftPtr = imagDMX[0][k];
727 2707021 : outRealRightPtr = realDMX[1][k];
728 2707021 : outImagRightPtr = imagDMX[1][k];
729 2707021 : set_zero( outRealLeftPtr, CLDFB_NO_CHANNELS_MAX );
730 2707021 : set_zero( outImagLeftPtr, CLDFB_NO_CHANNELS_MAX );
731 2707021 : set_zero( outRealRightPtr, CLDFB_NO_CHANNELS_MAX );
732 2707021 : set_zero( outImagRightPtr, CLDFB_NO_CHANNELS_MAX );
733 :
734 : /*Ambisonics input requires different processing*/
735 2707021 : if ( hBinRenderer->nInChannels == HOA3_CHANNELS )
736 : {
737 : float *inRealPtr_W, *inImagPtr_W;
738 : float *inRealPtr_Y, *inImagPtr_Y;
739 :
740 2044477 : inRealPtr_W = (float *) &( RealBuffer[0][k][0] );
741 2044477 : inImagPtr_W = (float *) &( ImagBuffer[0][k][0] );
742 :
743 2044477 : inRealPtr_Y = (float *) &( RealBuffer[1][k][0] );
744 2044477 : inImagPtr_Y = (float *) &( ImagBuffer[1][k][0] );
745 :
746 81179277 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
747 : {
748 79134800 : outRealLeftPtr[bandIdx] = inRealPtr_W[bandIdx] + inRealPtr_Y[bandIdx];
749 79134800 : outImagLeftPtr[bandIdx] = inImagPtr_W[bandIdx] + inImagPtr_Y[bandIdx];
750 :
751 79134800 : outRealRightPtr[bandIdx] = inRealPtr_W[bandIdx] - inRealPtr_Y[bandIdx];
752 79134800 : outImagRightPtr[bandIdx] = inImagPtr_W[bandIdx] - inImagPtr_Y[bandIdx];
753 : }
754 : }
755 : else
756 : {
757 7950528 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
758 : {
759 7287984 : float foa_const = hBinRenderer->hReverb->foa_enc[chIdx][1];
760 :
761 7287984 : inRealPtr = (float *) &( RealBuffer[chIdx][k][0] );
762 7287984 : inImagPtr = (float *) &( ImagBuffer[chIdx][k][0] );
763 :
764 292107024 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
765 : {
766 284819040 : outRealLeftPtr[bandIdx] += inRealPtr[bandIdx] * ( 1.f + foa_const );
767 284819040 : outImagLeftPtr[bandIdx] += inImagPtr[bandIdx] * ( 1.f + foa_const );
768 :
769 284819040 : outRealRightPtr[bandIdx] += inRealPtr[bandIdx] * ( 1.f - foa_const );
770 284819040 : outImagRightPtr[bandIdx] += inImagPtr[bandIdx] * ( 1.f - foa_const );
771 : }
772 : }
773 : }
774 : }
775 : }
776 :
777 1108846 : 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 8213 : 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 8213 : 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 8213 : hBinRenderer->hInputSetup = &st_ivas->hIntSetup;
896 :
897 : /* Define of head rotation has to be done in binRendeder in CLDFB*/
898 8213 : hBinRenderer->rotInCldfb = 0;
899 8213 : if ( st_ivas->ivas_format == MC_FORMAT || st_ivas->ivas_format == SBA_FORMAT || st_ivas->ivas_format == SBA_ISM_FORMAT )
900 : {
901 8213 : hBinRenderer->rotInCldfb = 1;
902 : }
903 :
904 8213 : 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 660 : hBinRenderer->numPoses = st_ivas->hSplitBinRend->splitrend.multiBinPoseData.num_poses;
910 : #endif
911 : }
912 : else
913 : {
914 7553 : 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 8213 : if ( st_ivas->hIntSetup.is_loudspeaker_setup )
920 : {
921 2522 : hBinRenderer->ivas_format = MC_FORMAT;
922 : }
923 : else
924 : {
925 5691 : hBinRenderer->ivas_format = SBA_FORMAT;
926 : }
927 8213 : hBinRenderer->max_band = (int16_t) ( ( BINAURAL_MAXBANDS * st_ivas->hDecoderConfig->output_Fs ) / 48000 );
928 8213 : convBand = hBinRenderer->max_band;
929 :
930 8213 : hBinRenderer->timeSlots = MAX_PARAM_SPATIAL_SUBFRAMES; /* Corresponds to 5 msec sound to motion latency */
931 :
932 8213 : if ( convBand > BINAURAL_CONVBANDS )
933 : {
934 3671 : hBinRenderer->conv_band = BINAURAL_CONVBANDS;
935 : }
936 : else
937 : {
938 4542 : hBinRenderer->conv_band = convBand;
939 : }
940 :
941 : /*LFE rendering switched off by default*/
942 8213 : hBinRenderer->render_lfe = 0;
943 :
944 8213 : if ( st_ivas->ivas_format != ISM_FORMAT && st_ivas->hIntSetup.is_loudspeaker_setup )
945 : {
946 2522 : hBinRenderer->render_lfe = 1;
947 : }
948 :
949 8213 : 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 8213 : 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 8213 : if ( st_ivas->renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM && ( st_ivas->hIntSetup.is_loudspeaker_setup == 0 ) )
961 453 : {
962 : IVAS_OUTPUT_SETUP out_setup;
963 :
964 : /* Allocate memories and buffers needed for convolutional module in CICP19 */
965 453 : 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 453 : ivas_output_init( &out_setup, IVAS_AUDIO_CONFIG_7_1_4 );
971 :
972 453 : if ( st_ivas->hoa_dec_mtx == NULL )
973 : {
974 453 : 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 453 : hBinRenderer->hoa_dec_mtx = st_ivas->hoa_dec_mtx;
981 453 : 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 7760 : 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 7760 : 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 8213 : 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 4741 : pRoomAcoustics = ( st_ivas->hOutSetup.output_config == IVAS_AUDIO_CONFIG_BINAURAL_ROOM_REVERB ) ? &( st_ivas->hRenderConfig->roomAcoustics ) : NULL;
998 :
999 4741 : if ( ( error = ivas_binaural_reverb_init( &( hBinRenderer->hReverb ),
1000 : st_ivas->hHrtfStatistics,
1001 4741 : hBinRenderer->conv_band,
1002 4741 : hBinRenderer->timeSlots,
1003 : pRoomAcoustics,
1004 4741 : st_ivas->hDecoderConfig->output_Fs,
1005 4741 : st_ivas->hHrtfFastConv->fastconvReverberationTimes,
1006 4741 : st_ivas->hHrtfFastConv->fastconvReverberationEneCorrections,
1007 : NULL ) ) != IVAS_ERR_OK )
1008 :
1009 : {
1010 0 : return error;
1011 : }
1012 : }
1013 : else
1014 : {
1015 3472 : hBinRenderer->hReverb = NULL;
1016 : }
1017 :
1018 8213 : hBinRenderer->hEFAPdata = NULL;
1019 :
1020 8213 : if ( hBinRenderer->hReverb != NULL && hBinRenderer->nInChannels != HOA3_CHANNELS )
1021 : {
1022 2592 : if ( hBinRenderer->hInputSetup->is_loudspeaker_setup == 0 )
1023 : {
1024 5436 : for ( k = 0; k < 11; k++ )
1025 : {
1026 4983 : 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 2139 : else if ( st_ivas->ivas_format == MC_FORMAT && ( st_ivas->hDecoderConfig->Opt_Headrotation || st_ivas->hDecoderConfig->Opt_ExternalOrientation ) )
1030 : {
1031 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 )
1032 : {
1033 0 : return error;
1034 : }
1035 :
1036 : /* Copy handles to bin renderer handle*/
1037 6 : hBinRenderer->hEFAPdata = st_ivas->hEFAPdata;
1038 : }
1039 : }
1040 :
1041 : /* Copy the handles to main handle */
1042 8213 : st_ivas->hBinRenderer = hBinRenderer;
1043 :
1044 8213 : return IVAS_ERR_OK;
1045 : }
1046 :
1047 :
1048 : /*-------------------------------------------------------------------------
1049 : * ivas_binRenderer_convModuleClose()
1050 : *
1051 : * Close convolution module handle of fastconv binaural renderer
1052 : *------------------------------------------------------------------------*/
1053 :
1054 8221 : static void ivas_binRenderer_convModuleClose(
1055 : BINAURAL_RENDERER_HANDLE *hBinRenderer, /* i/o: fastconv binaural renderer handle */
1056 : const int16_t num_poses /* i : number of poses */
1057 : )
1058 : {
1059 : int16_t bandIdx, chIdx;
1060 : int16_t posIdx;
1061 : BINRENDERER_CONV_MODULE_HANDLE hBinRenConvModule;
1062 :
1063 8221 : hBinRenConvModule = ( *hBinRenderer )->hBinRenConvModule;
1064 :
1065 8221 : if ( hBinRenConvModule == NULL )
1066 : {
1067 0 : return;
1068 : }
1069 :
1070 327111 : for ( bandIdx = 0; bandIdx < ( *hBinRenderer )->conv_band; bandIdx++ )
1071 : {
1072 318890 : free( hBinRenConvModule->filterTapsLeftReal[bandIdx] );
1073 318890 : hBinRenConvModule->filterTapsLeftReal[bandIdx] = NULL;
1074 :
1075 318890 : free( hBinRenConvModule->filterTapsLeftImag[bandIdx] );
1076 318890 : hBinRenConvModule->filterTapsLeftImag[bandIdx] = NULL;
1077 :
1078 318890 : free( hBinRenConvModule->filterTapsRightReal[bandIdx] );
1079 318890 : hBinRenConvModule->filterTapsRightReal[bandIdx] = NULL;
1080 :
1081 318890 : free( hBinRenConvModule->filterTapsRightImag[bandIdx] );
1082 318890 : hBinRenConvModule->filterTapsRightImag[bandIdx] = NULL;
1083 : }
1084 :
1085 8221 : free( hBinRenConvModule->filterTapsLeftReal );
1086 8221 : hBinRenConvModule->filterTapsLeftReal = NULL;
1087 :
1088 8221 : free( hBinRenConvModule->filterTapsLeftImag );
1089 8221 : hBinRenConvModule->filterTapsLeftImag = NULL;
1090 :
1091 8221 : free( hBinRenConvModule->filterTapsRightReal );
1092 8221 : hBinRenConvModule->filterTapsRightReal = NULL;
1093 :
1094 8221 : free( hBinRenConvModule->filterTapsRightImag );
1095 8221 : hBinRenConvModule->filterTapsRightImag = NULL;
1096 :
1097 18250 : for ( posIdx = 0; posIdx < num_poses; posIdx++ )
1098 : {
1099 419319 : for ( bandIdx = 0; bandIdx < ( *hBinRenderer )->conv_band; bandIdx++ )
1100 : {
1101 6203760 : for ( chIdx = 0; chIdx < ( *hBinRenderer )->nInChannels; chIdx++ )
1102 : {
1103 5794470 : free( hBinRenConvModule->filterStatesLeftReal[posIdx][bandIdx][chIdx] );
1104 5794470 : hBinRenConvModule->filterStatesLeftReal[posIdx][bandIdx][chIdx] = NULL;
1105 :
1106 5794470 : free( hBinRenConvModule->filterStatesLeftImag[posIdx][bandIdx][chIdx] );
1107 5794470 : hBinRenConvModule->filterStatesLeftImag[posIdx][bandIdx][chIdx] = NULL;
1108 : }
1109 :
1110 409290 : free( hBinRenConvModule->filterStatesLeftReal[posIdx][bandIdx] );
1111 409290 : hBinRenConvModule->filterStatesLeftReal[posIdx][bandIdx] = NULL;
1112 :
1113 409290 : free( hBinRenConvModule->filterStatesLeftImag[posIdx][bandIdx] );
1114 409290 : hBinRenConvModule->filterStatesLeftImag[posIdx][bandIdx] = NULL;
1115 : }
1116 :
1117 10029 : free( hBinRenConvModule->filterStatesLeftReal[posIdx] );
1118 10029 : hBinRenConvModule->filterStatesLeftReal[posIdx] = NULL;
1119 :
1120 10029 : free( hBinRenConvModule->filterStatesLeftImag[posIdx] );
1121 10029 : hBinRenConvModule->filterStatesLeftImag[posIdx] = NULL;
1122 : }
1123 8221 : free( hBinRenConvModule->filterStatesLeftReal );
1124 8221 : hBinRenConvModule->filterStatesLeftReal = NULL;
1125 :
1126 8221 : free( hBinRenConvModule->filterStatesLeftImag );
1127 8221 : hBinRenConvModule->filterStatesLeftImag = NULL;
1128 :
1129 8221 : free( ( *hBinRenderer )->hBinRenConvModule );
1130 8221 : ( *hBinRenderer )->hBinRenConvModule = NULL;
1131 :
1132 8221 : return;
1133 : }
1134 :
1135 :
1136 : /*-------------------------------------------------------------------------
1137 : * ivas_binRenderer_close()
1138 : *
1139 : * Close fastconv binaural renderer memories
1140 : *------------------------------------------------------------------------*/
1141 :
1142 88009 : void ivas_binRenderer_close(
1143 : BINAURAL_RENDERER_HANDLE *hBinRenderer /* i/o: fastconv binaural renderer handle */
1144 : )
1145 : {
1146 88009 : if ( hBinRenderer == NULL || *hBinRenderer == NULL )
1147 : {
1148 79788 : return;
1149 : }
1150 :
1151 8221 : if ( ( *hBinRenderer )->hBinRenConvModule != NULL )
1152 : {
1153 8221 : ivas_binRenderer_convModuleClose( hBinRenderer, ( *hBinRenderer )->numPoses );
1154 : }
1155 :
1156 8221 : if ( ( *hBinRenderer )->hReverb != NULL )
1157 : {
1158 4741 : ivas_binaural_reverb_close( &( ( *hBinRenderer )->hReverb ) );
1159 : }
1160 :
1161 8221 : free( *hBinRenderer );
1162 8221 : *hBinRenderer = NULL;
1163 :
1164 8221 : return;
1165 : }
1166 :
1167 :
1168 : /*-------------------------------------------------------------------------
1169 : * ivas_free_pppHrtfMem()
1170 : *
1171 : * Free fastconv binaural renderer hrtf memories
1172 : *------------------------------------------------------------------------*/
1173 :
1174 29044 : static void ivas_free_pppHrtfMem(
1175 : float ****ppppHRIR,
1176 : const int16_t dim,
1177 : const int16_t alloc_init )
1178 : {
1179 : int16_t i, j;
1180 :
1181 29044 : if ( *ppppHRIR != NULL )
1182 : {
1183 1481244 : for ( i = 0; i < BINAURAL_CONVBANDS; i++ )
1184 : {
1185 1452200 : if ( alloc_init == 0 )
1186 : {
1187 7601400 : for ( j = 0; j < dim; j++ )
1188 : {
1189 7144800 : free( ( *ppppHRIR )[i][j] );
1190 7144800 : ( *ppppHRIR )[i][j] = NULL;
1191 : }
1192 : }
1193 1452200 : free( ( *ppppHRIR )[i] );
1194 1452200 : ( *ppppHRIR )[i] = NULL;
1195 : }
1196 29044 : free( *ppppHRIR );
1197 29044 : *ppppHRIR = NULL;
1198 : }
1199 :
1200 29044 : return;
1201 : }
1202 :
1203 :
1204 : /*-------------------------------------------------------------------------
1205 : * ivas_binaural_hrtf_close()
1206 : *
1207 : * Close fastconv binaural renderer hrtf memories
1208 : *------------------------------------------------------------------------*/
1209 :
1210 96056 : void ivas_binaural_hrtf_close(
1211 : HRTFS_FASTCONV_HANDLE *hHrtfFastConv /* i : fastconv HRTF handle */
1212 : )
1213 : {
1214 : int16_t allocate_init_flag;
1215 : int16_t n_channels;
1216 :
1217 96056 : if ( hHrtfFastConv == NULL || *hHrtfFastConv == NULL )
1218 : {
1219 88795 : return;
1220 : }
1221 :
1222 7261 : allocate_init_flag = ( *hHrtfFastConv )->allocate_init_flag;
1223 7261 : n_channels = ( *hHrtfFastConv )->n_channels;
1224 :
1225 7261 : ivas_free_pppHrtfMem( &( *hHrtfFastConv )->leftReal, n_channels, allocate_init_flag );
1226 7261 : ivas_free_pppHrtfMem( &( *hHrtfFastConv )->leftImag, n_channels, allocate_init_flag );
1227 7261 : ivas_free_pppHrtfMem( &( *hHrtfFastConv )->rightReal, n_channels, allocate_init_flag );
1228 7261 : ivas_free_pppHrtfMem( &( *hHrtfFastConv )->rightImag, n_channels, allocate_init_flag );
1229 :
1230 7261 : return;
1231 : }
1232 :
1233 :
1234 : /*-------------------------------------------------------------------------*
1235 : * ivas_binaural_add_LFE()
1236 : *
1237 : * The functions adds the LFE to the left and right channels after binaural rendering
1238 : *-------------------------------------------------------------------------*/
1239 :
1240 381030 : void ivas_binaural_add_LFE(
1241 : Decoder_Struct *st_ivas, /* i/o: IVAS decoder structure */
1242 : int16_t output_frame, /* i : length of input frame */
1243 : float *input_f[], /* i : transport channels */
1244 : float *output_f[] /* o : synthesized core-coder transport channels/DirAC output */
1245 : )
1246 : {
1247 : int16_t render_lfe, idx_lfe;
1248 : float gain;
1249 : float lfe_tc[L_FRAME48k];
1250 :
1251 381030 : if ( st_ivas->hBinRenderer != NULL )
1252 : {
1253 2461 : render_lfe = st_ivas->hBinRenderer->render_lfe;
1254 : }
1255 : else
1256 : {
1257 378569 : render_lfe = TRUE;
1258 : }
1259 :
1260 381030 : if ( render_lfe )
1261 : {
1262 381030 : if ( st_ivas->renderer_type == RENDERER_BINAURAL_OBJECTS_TD )
1263 : {
1264 238774 : gain = GAIN_LFE;
1265 : }
1266 : else
1267 : {
1268 142256 : gain = ( ( st_ivas->hCrendWrapper != NULL ) && ( st_ivas->hCrendWrapper->hHrtfCrend != NULL ) ) ? st_ivas->hCrendWrapper->hHrtfCrend->gain_lfe : GAIN_LFE;
1269 : }
1270 :
1271 760573 : for ( idx_lfe = 0; idx_lfe < st_ivas->hIntSetup.num_lfe; idx_lfe++ )
1272 : {
1273 379543 : v_multc( input_f[st_ivas->hIntSetup.index_lfe[idx_lfe]], gain, lfe_tc, output_frame );
1274 : /* copy LFE to left and right channels */
1275 379543 : v_add( output_f[0], lfe_tc, output_f[0], output_frame );
1276 379543 : v_add( output_f[1], lfe_tc, output_f[1], output_frame );
1277 : }
1278 : }
1279 :
1280 381030 : return;
1281 : }
1282 :
1283 :
1284 : /*-------------------------------------------------------------------------
1285 : * ivas_binRenderer()
1286 : *
1287 : * Fastconv binaural renderer main function
1288 : *-------------------------------------------------------------------------*/
1289 :
1290 2098247 : void ivas_binRenderer(
1291 : BINAURAL_RENDERER_HANDLE hBinRenderer, /* i/o: binaural renderer handle */
1292 : const MULTI_BIN_REND_POSE_DATA *pMultiBinPoseData,
1293 : COMBINED_ORIENTATION_HANDLE hCombinedOrientationData, /* i : combined head and external orientation handle*/
1294 : const int16_t numTimeSlots, /* i : number of time slots to render */
1295 : #ifdef SPLIT_REND_WITH_HEAD_ROT_DEBUG
1296 : HEAD_TRACK_DATA_HANDLE hPostRendHeadTrackData,
1297 : #endif
1298 : float Cldfb_RealBuffer_Binaural[][BINAURAL_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX], /* o : Rotated Binaural signals */
1299 : float Cldfb_ImagBuffer_Binaural[][BINAURAL_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX], /* o : Rotated Binaural signals */
1300 : float RealBuffer[][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX], /* i : LS signals */
1301 : float ImagBuffer[][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX] /* i : LS signals */
1302 : )
1303 : {
1304 : int16_t chIdx, k;
1305 : int16_t pos_idx, num_poses;
1306 : float RealBuffer_local[MAX_OUTPUT_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX];
1307 : float ImagBuffer_local[MAX_OUTPUT_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX];
1308 :
1309 2098247 : push_wmops( "fastconv_binaural_rendering" );
1310 2098247 : num_poses = hBinRenderer->numPoses;
1311 :
1312 : /* Compute Convolution */
1313 : /* memory reset for the binaural output */
1314 5314124 : for ( pos_idx = 0; pos_idx < num_poses; pos_idx++ )
1315 : {
1316 9647631 : for ( chIdx = 0; chIdx < BINAURAL_CHANNELS; chIdx++ )
1317 : {
1318 31747468 : for ( k = 0; k < numTimeSlots; k++ )
1319 : {
1320 25315714 : set_zero( Cldfb_RealBuffer_Binaural[pos_idx][chIdx][k], CLDFB_NO_CHANNELS_MAX );
1321 25315714 : set_zero( Cldfb_ImagBuffer_Binaural[pos_idx][chIdx][k], CLDFB_NO_CHANNELS_MAX );
1322 : }
1323 : }
1324 : }
1325 :
1326 32593555 : for ( chIdx = 0; chIdx < hBinRenderer->hInputSetup->nchan_out_woLFE; chIdx++ )
1327 : {
1328 151417356 : for ( k = 0; k < numTimeSlots; k++ )
1329 : {
1330 120922048 : mvr2r( RealBuffer[chIdx][k], RealBuffer_local[chIdx][k], CLDFB_NO_CHANNELS_MAX );
1331 120922048 : mvr2r( ImagBuffer[chIdx][k], ImagBuffer_local[chIdx][k], CLDFB_NO_CHANNELS_MAX );
1332 : }
1333 : }
1334 :
1335 : /* Head rotation in HOA3 or CICPx */
1336 2098247 : if ( hCombinedOrientationData != NULL && hCombinedOrientationData->enableCombinedOrientation[hCombinedOrientationData->subframe_idx] && hBinRenderer->rotInCldfb )
1337 : {
1338 609694 : if ( hBinRenderer->hInputSetup->is_loudspeaker_setup == 0 )
1339 : {
1340 : /* Rotation in SHD (HOA3) */
1341 585694 : if ( hCombinedOrientationData->shd_rot_max_order == -1 )
1342 : {
1343 210849 : rotateFrame_shd_cldfb( RealBuffer, ImagBuffer, hCombinedOrientationData->Rmat[hCombinedOrientationData->subframe_idx], hBinRenderer->hInputSetup->nchan_out_woLFE, numTimeSlots, 3 );
1344 : }
1345 374845 : else if ( hCombinedOrientationData->shd_rot_max_order > 0 )
1346 : {
1347 43734 : rotateFrame_shd_cldfb( RealBuffer, ImagBuffer, hCombinedOrientationData->Rmat[hCombinedOrientationData->subframe_idx], hBinRenderer->hInputSetup->nchan_out_woLFE, numTimeSlots, hCombinedOrientationData->shd_rot_max_order );
1348 : }
1349 : }
1350 : else
1351 : {
1352 : /* Rotation in SD (CICPx) */
1353 24000 : rotateFrame_sd_cldfb( hCombinedOrientationData->Rmat[hCombinedOrientationData->subframe_idx], RealBuffer, ImagBuffer, hBinRenderer->hInputSetup, hBinRenderer->hEFAPdata, numTimeSlots, hBinRenderer->conv_band );
1354 : }
1355 : }
1356 :
1357 : /* HOA decoding to CICP19 if needed*/
1358 2098247 : if ( hBinRenderer->hInputSetup->is_loudspeaker_setup == 0 &&
1359 1618619 : ( hBinRenderer->nInChannels != HOA3_CHANNELS && hBinRenderer->nInChannels != HOA2_CHANNELS && hBinRenderer->nInChannels != FOA_CHANNELS ) )
1360 : {
1361 165636 : ivas_sba2mc_cldfb( *( hBinRenderer->hInputSetup ), RealBuffer, ImagBuffer, hBinRenderer->nInChannels, hBinRenderer->conv_band, numTimeSlots, hBinRenderer->hoa_dec_mtx );
1362 : }
1363 :
1364 2098247 : ivas_binRenderer_filterModule( Cldfb_RealBuffer_Binaural[0], Cldfb_ImagBuffer_Binaural[0], RealBuffer, ImagBuffer, numTimeSlots, hBinRenderer, 0 );
1365 :
1366 2098247 : if ( pMultiBinPoseData != NULL )
1367 : {
1368 415347 : if ( pMultiBinPoseData->num_poses > 1 )
1369 : {
1370 : IVAS_QUATERNION Quaternions_rel, Quaternions_abs, *Quaternions_ref;
1371 : float Rmat_local[3][3];
1372 :
1373 274061 : if ( hCombinedOrientationData && hBinRenderer->rotInCldfb )
1374 : {
1375 274061 : Quaternions_ref = &hCombinedOrientationData->Quaternions[0];
1376 274061 : Quaternions_rel.w = -3.0f; /*euler*/
1377 274061 : Quaternions_abs.w = -3.0f;
1378 :
1379 274061 : if ( hCombinedOrientationData->shd_rot_max_order == 0 )
1380 : {
1381 : /*HOA signal already rotated by DirAC*/
1382 133781 : Quaternions_abs.x = 0.0f;
1383 133781 : Quaternions_abs.y = 0.0f;
1384 133781 : Quaternions_abs.z = 0.0f;
1385 : }
1386 : else
1387 : {
1388 : /*euler*/
1389 140280 : Quat2EulerDegree( *Quaternions_ref, &Quaternions_abs.z, &Quaternions_abs.y, &Quaternions_abs.x ); /*order in Quat2Euler seems to be reversed ?*/
1390 : }
1391 :
1392 1391691 : for ( pos_idx = 1; pos_idx < pMultiBinPoseData->num_poses; pos_idx++ )
1393 : {
1394 18999710 : for ( chIdx = 0; chIdx < hBinRenderer->hInputSetup->nchan_out_woLFE; chIdx++ )
1395 : {
1396 87179168 : for ( k = 0; k < numTimeSlots; k++ )
1397 : {
1398 69297088 : mvr2r( RealBuffer_local[chIdx][k], RealBuffer[chIdx][k], CLDFB_NO_CHANNELS_MAX );
1399 69297088 : mvr2r( ImagBuffer_local[chIdx][k], ImagBuffer[chIdx][k], CLDFB_NO_CHANNELS_MAX );
1400 : }
1401 : }
1402 1117630 : Quaternions_rel.x = pMultiBinPoseData->relative_head_poses[pos_idx][0] - pMultiBinPoseData->relative_head_poses[pos_idx - 1][0];
1403 1117630 : Quaternions_rel.y = pMultiBinPoseData->relative_head_poses[pos_idx][1] - pMultiBinPoseData->relative_head_poses[pos_idx - 1][1];
1404 1117630 : Quaternions_rel.z = pMultiBinPoseData->relative_head_poses[pos_idx][2] - pMultiBinPoseData->relative_head_poses[pos_idx - 1][2];
1405 1117630 : Quaternions_abs.x = Quaternions_abs.x + Quaternions_rel.x;
1406 1117630 : Quaternions_abs.y = Quaternions_abs.y + Quaternions_rel.y;
1407 1117630 : Quaternions_abs.z = Quaternions_abs.z + Quaternions_rel.z;
1408 :
1409 1117630 : QuatToRotMat( Quaternions_abs, Rmat_local );
1410 :
1411 1117630 : if ( hBinRenderer->hInputSetup->is_loudspeaker_setup )
1412 : {
1413 0 : rotateFrame_sd_cldfb( Rmat_local, RealBuffer, ImagBuffer, hBinRenderer->hInputSetup, hBinRenderer->hEFAPdata, numTimeSlots, hBinRenderer->conv_band );
1414 : }
1415 : else
1416 : {
1417 1117630 : rotateFrame_shd_cldfb( RealBuffer, ImagBuffer, Rmat_local, hBinRenderer->hInputSetup->nchan_out_woLFE, numTimeSlots, hBinRenderer->hInputSetup->ambisonics_order );
1418 : }
1419 :
1420 1117630 : ivas_binRenderer_filterModule( Cldfb_RealBuffer_Binaural[pos_idx], Cldfb_ImagBuffer_Binaural[pos_idx], RealBuffer, ImagBuffer, numTimeSlots, hBinRenderer, pos_idx );
1421 : }
1422 : }
1423 : }
1424 : }
1425 :
1426 : /* Obtain the binaural dmx and compute the reverb */
1427 2098247 : if ( hBinRenderer->hReverb != NULL )
1428 : {
1429 : float reverbRe[BINAURAL_CHANNELS][CLDFB_SLOTS_PER_SUBFRAME][CLDFB_NO_CHANNELS_MAX];
1430 : float reverbIm[BINAURAL_CHANNELS][CLDFB_SLOTS_PER_SUBFRAME][CLDFB_NO_CHANNELS_MAX];
1431 : float inRe[BINAURAL_CHANNELS][CLDFB_SLOTS_PER_SUBFRAME][CLDFB_NO_CHANNELS_MAX];
1432 : float inIm[BINAURAL_CHANNELS][CLDFB_SLOTS_PER_SUBFRAME][CLDFB_NO_CHANNELS_MAX];
1433 :
1434 1108846 : ivas_binaural_obtain_DMX( numTimeSlots, hBinRenderer, RealBuffer, ImagBuffer, inRe, inIm );
1435 :
1436 3326538 : for ( chIdx = 0; chIdx < BINAURAL_CHANNELS; chIdx++ )
1437 : {
1438 11084854 : for ( k = 0; k < numTimeSlots; k++ )
1439 : {
1440 8867162 : set_zero( reverbRe[chIdx][k], hBinRenderer->max_band );
1441 8867162 : set_zero( reverbIm[chIdx][k], hBinRenderer->max_band );
1442 : }
1443 : }
1444 :
1445 1108846 : ivas_binaural_reverb_processSubframe( hBinRenderer->hReverb, BINAURAL_CHANNELS, numTimeSlots, inRe, inIm, reverbRe, reverbIm );
1446 :
1447 : /* Add the conv module and reverb module output */
1448 3326538 : for ( chIdx = 0; chIdx < BINAURAL_CHANNELS; chIdx++ )
1449 : {
1450 11084854 : for ( k = 0; k < numTimeSlots; k++ )
1451 : {
1452 17734324 : for ( pos_idx = 0; pos_idx < num_poses; pos_idx++ )
1453 : {
1454 : /* Combine first and second parts to generate binaural output signal with room effect */
1455 8867162 : v_add( Cldfb_RealBuffer_Binaural[pos_idx][chIdx][k], reverbRe[chIdx][k], Cldfb_RealBuffer_Binaural[pos_idx][chIdx][k], hBinRenderer->conv_band );
1456 8867162 : v_add( Cldfb_ImagBuffer_Binaural[pos_idx][chIdx][k], reverbIm[chIdx][k], Cldfb_ImagBuffer_Binaural[pos_idx][chIdx][k], hBinRenderer->conv_band );
1457 : }
1458 : }
1459 : }
1460 : }
1461 :
1462 2098247 : pop_wmops();
1463 2098247 : return;
1464 : }
1465 :
1466 :
1467 : /*-------------------------------------------------------------------------
1468 : * ivas_rend_CldfbMultiBinRendProcess()
1469 : *
1470 : *
1471 : *-------------------------------------------------------------------------*/
1472 :
1473 1248 : void ivas_rend_CldfbMultiBinRendProcess(
1474 : const BINAURAL_RENDERER_HANDLE hCldfbRend,
1475 : const COMBINED_ORIENTATION_HANDLE *pCombinedOrientationData,
1476 : const MULTI_BIN_REND_POSE_DATA *pMultiBinPoseData,
1477 : float Cldfb_In_Real[][CLDFB_NO_COL_MAX][CLDFB_NO_CHANNELS_MAX],
1478 : float Cldfb_In_Imag[][CLDFB_NO_COL_MAX][CLDFB_NO_CHANNELS_MAX],
1479 : float Cldfb_Out_Real[MAX_HEAD_ROT_POSES * BINAURAL_CHANNELS][CLDFB_NO_COL_MAX][CLDFB_NO_CHANNELS_MAX], /* o : Binaural signals */
1480 : float Cldfb_Out_Imag[MAX_HEAD_ROT_POSES * BINAURAL_CHANNELS][CLDFB_NO_COL_MAX][CLDFB_NO_CHANNELS_MAX],
1481 : const int16_t low_res_pre_rend_rot,
1482 : const int16_t num_subframes )
1483 : {
1484 : int16_t slot_idx, ch_idx, idx, pose_idx, i, j;
1485 : int16_t sf_idx;
1486 : float Cldfb_RealBuffer_sfIn[MAX_INPUT_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX];
1487 : float Cldfb_ImagBuffer_sfIn[MAX_INPUT_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX];
1488 : #ifdef SPLIT_REND_WITH_HEAD_ROT_DEBUG
1489 : HEAD_TRACK_DATA head_track_post;
1490 : float Cldfb_RealBuffer_Binaural[MAX_HEAD_ROT_POSES + 1][BINAURAL_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX];
1491 : float Cldfb_ImagBuffer_Binaural[MAX_HEAD_ROT_POSES + 1][BINAURAL_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX];
1492 : #else
1493 : float Cldfb_RealBuffer_Binaural[MAX_HEAD_ROT_POSES][BINAURAL_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX];
1494 : float Cldfb_ImagBuffer_Binaural[MAX_HEAD_ROT_POSES][BINAURAL_CHANNELS][MAX_PARAM_SPATIAL_SUBFRAMES][CLDFB_NO_CHANNELS_MAX];
1495 : #endif
1496 :
1497 6240 : for ( sf_idx = 0; sf_idx < num_subframes; sf_idx++ )
1498 : {
1499 24960 : for ( slot_idx = 0; slot_idx < MAX_PARAM_SPATIAL_SUBFRAMES; slot_idx++ )
1500 : {
1501 19968 : idx = sf_idx * MAX_PARAM_SPATIAL_SUBFRAMES + slot_idx;
1502 339456 : for ( ch_idx = 0; ch_idx < hCldfbRend->nInChannels; ch_idx++ )
1503 : {
1504 319488 : mvr2r( &Cldfb_In_Real[ch_idx][idx][0], &Cldfb_RealBuffer_sfIn[ch_idx][slot_idx][0], hCldfbRend->max_band );
1505 319488 : mvr2r( &Cldfb_In_Imag[ch_idx][idx][0], &Cldfb_ImagBuffer_sfIn[ch_idx][slot_idx][0], hCldfbRend->max_band );
1506 : }
1507 : }
1508 :
1509 4992 : if ( ( *pCombinedOrientationData ) != NULL )
1510 : {
1511 4992 : if ( ( low_res_pre_rend_rot ) && ( pMultiBinPoseData->poseCorrectionMode == ISAR_SPLIT_REND_POSE_CORRECTION_MODE_CLDFB ) )
1512 : {
1513 4992 : ( *pCombinedOrientationData )->Quaternions[sf_idx] = ( *pCombinedOrientationData )->Quaternions[0];
1514 19968 : for ( i = 0; i < 3; i++ )
1515 : {
1516 59904 : for ( j = 0; j < 3; j++ )
1517 : {
1518 44928 : ( *pCombinedOrientationData )->Rmat[sf_idx][i][j] = ( *pCombinedOrientationData )->Rmat[0][i][j];
1519 : }
1520 : }
1521 : }
1522 4992 : ( *pCombinedOrientationData )->shd_rot_max_order = -1;
1523 : }
1524 :
1525 : #ifdef SPLIT_REND_WITH_HEAD_ROT_DEBUG
1526 : head_track_post.num_quaternions = 0;
1527 : head_track_post.shd_rot_max_order = -1;
1528 : head_track_post.Quaternions[0] = ivas_split_rend_get_sf_rot_data( pHeadRotData->headPositionsPostRend, sf_idx );
1529 :
1530 : #endif
1531 : #ifdef SPLIT_REND_WITH_HEAD_ROT_DEBUG
1532 : ivas_binRenderer( hCldfbRend, pMultiBinPoseData, *pCombinedOrientationData, MAX_PARAM_SPATIAL_SUBFRAMES, &head_track_post, Cldfb_RealBuffer_Binaural, Cldfb_ImagBuffer_Binaural, Cldfb_RealBuffer_sfIn, Cldfb_ImagBuffer_sfIn );
1533 : #else
1534 4992 : ivas_binRenderer( hCldfbRend, pMultiBinPoseData, *pCombinedOrientationData, MAX_PARAM_SPATIAL_SUBFRAMES, Cldfb_RealBuffer_Binaural, Cldfb_ImagBuffer_Binaural, Cldfb_RealBuffer_sfIn, Cldfb_ImagBuffer_sfIn );
1535 : #endif
1536 :
1537 29952 : for ( pose_idx = 0; pose_idx < hCldfbRend->numPoses; pose_idx++ )
1538 : {
1539 124800 : for ( slot_idx = 0; slot_idx < MAX_PARAM_SPATIAL_SUBFRAMES; slot_idx++ )
1540 : {
1541 99840 : idx = sf_idx * MAX_PARAM_SPATIAL_SUBFRAMES + slot_idx;
1542 299520 : for ( ch_idx = 0; ch_idx < BINAURAL_CHANNELS; ch_idx++ )
1543 : {
1544 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 );
1545 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 );
1546 : }
1547 : }
1548 : }
1549 : }
1550 :
1551 1248 : return;
1552 : }
|
