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 1308104 : 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 66014034 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
83 : {
84 1078958210 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
85 : {
86 1014252280 : filterStatesLeftRealPtr = (float *) &( hBinRenderer->hBinRenConvModule->filterStatesLeftReal[pos_idx][bandIdx][chIdx][0] );
87 1014252280 : filterStatesLeftImagPtr = (float *) &( hBinRenderer->hBinRenConvModule->filterStatesLeftImag[pos_idx][bandIdx][chIdx][0] );
88 :
89 1014252280 : filterTapsLeftRealPtr = hBinRenderer->hBinRenConvModule->filterTapsLeftReal[bandIdx][chIdx];
90 1014252280 : filterTapsLeftImagPtr = hBinRenderer->hBinRenConvModule->filterTapsLeftImag[bandIdx][chIdx];
91 1014252280 : filterTapsRightRealPtr = hBinRenderer->hBinRenConvModule->filterTapsRightReal[bandIdx][chIdx];
92 1014252280 : filterTapsRightImagPtr = hBinRenderer->hBinRenConvModule->filterTapsRightImag[bandIdx][chIdx];
93 :
94 4915467960 : for ( k = 0; k < numTimeSlots; k++ )
95 : {
96 3901215680 : float outRealLeft = 0.0f, outRealRight = 0.0f, outImagLeft = 0.0f, outImagRight = 0.0f;
97 :
98 15781985120 : for ( tapIdx = hBinRenderer->hBinRenConvModule->numTapsArray[bandIdx] - 1; tapIdx > 0; tapIdx-- )
99 : {
100 11880769440 : filterStatesLeftRealPtr[tapIdx] = filterStatesLeftRealPtr[tapIdx - 1];
101 11880769440 : filterStatesLeftImagPtr[tapIdx] = filterStatesLeftImagPtr[tapIdx - 1];
102 :
103 : /* Left Real and Imag */
104 11880769440 : outRealLeft += ( filterStatesLeftRealPtr[tapIdx] * filterTapsLeftRealPtr[tapIdx] ) - ( filterStatesLeftImagPtr[tapIdx] * filterTapsLeftImagPtr[tapIdx] );
105 11880769440 : outImagLeft += ( filterStatesLeftRealPtr[tapIdx] * filterTapsLeftImagPtr[tapIdx] ) + ( filterStatesLeftImagPtr[tapIdx] * filterTapsLeftRealPtr[tapIdx] );
106 :
107 : /* Right Real and Imag*/
108 11880769440 : outRealRight += ( filterStatesLeftRealPtr[tapIdx] * filterTapsRightRealPtr[tapIdx] ) - ( filterStatesLeftImagPtr[tapIdx] * filterTapsRightImagPtr[tapIdx] );
109 11880769440 : outImagRight += ( filterStatesLeftRealPtr[tapIdx] * filterTapsRightImagPtr[tapIdx] ) + ( filterStatesLeftImagPtr[tapIdx] * filterTapsRightRealPtr[tapIdx] );
110 : }
111 :
112 3901215680 : filterStatesLeftRealPtr[0] = CLDFB_real[chIdx][k][bandIdx];
113 3901215680 : filterStatesLeftImagPtr[0] = CLDFB_imag[chIdx][k][bandIdx];
114 :
115 :
116 : /* Left Real and Imag */
117 3901215680 : out_Conv_CLDFB_real[0][k][bandIdx] += outRealLeft + ( filterStatesLeftRealPtr[0] * filterTapsLeftRealPtr[0] ) - ( filterStatesLeftImagPtr[0] * filterTapsLeftImagPtr[0] );
118 3901215680 : out_Conv_CLDFB_imag[0][k][bandIdx] += outImagLeft + ( filterStatesLeftRealPtr[0] * filterTapsLeftImagPtr[0] ) + ( filterStatesLeftImagPtr[0] * filterTapsLeftRealPtr[0] );
119 :
120 : /* Right Real and Imag */
121 3901215680 : out_Conv_CLDFB_real[1][k][bandIdx] += outRealRight + ( filterStatesLeftRealPtr[0] * filterTapsRightRealPtr[0] ) - ( filterStatesLeftImagPtr[0] * filterTapsRightImagPtr[0] );
122 3901215680 : out_Conv_CLDFB_imag[1][k][bandIdx] += outImagRight + ( filterStatesLeftRealPtr[0] * filterTapsRightImagPtr[0] ) + ( filterStatesLeftImagPtr[0] * filterTapsRightRealPtr[0] );
123 : }
124 : }
125 : }
126 :
127 1308104 : return;
128 : }
129 :
130 :
131 : /*-------------------------------------------------------------------------
132 : * ivas_binRenderer_convModuleOpen()
133 : *
134 : * Open convolution module handle of fastconv binaural renderer
135 : *-------------------------------------------------------------------------*/
136 :
137 762 : 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 762 : 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 762 : if ( !isLoudspeaker )
159 : {
160 554 : hBinRenderer->nInChannels = audioCfg2channels( input_config );
161 : }
162 : else
163 : {
164 : /* Note: needs to be revisited if multiple LFE support is required */
165 208 : hBinRenderer->nInChannels = ( audioCfg2channels( input_config ) - isLoudspeaker );
166 : }
167 :
168 762 : hBinRenConvModule->numTaps = hHrtf->ntaps;
169 :
170 762 : if ( renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM )
171 : {
172 : /* Use variable order filtering */
173 70 : bandIdx = 0;
174 420 : for ( ; bandIdx < 5; bandIdx++ )
175 : {
176 350 : hBinRenConvModule->numTapsArray[bandIdx] = hBinRenConvModule->numTaps;
177 : }
178 420 : for ( ; bandIdx < 10; bandIdx++ )
179 : {
180 350 : hBinRenConvModule->numTapsArray[bandIdx] = (int16_t) ceilf( 0.6f * hBinRenConvModule->numTaps );
181 : }
182 770 : for ( ; bandIdx < 20; bandIdx++ )
183 : {
184 700 : hBinRenConvModule->numTapsArray[bandIdx] = (int16_t) ceilf( 0.5f * hBinRenConvModule->numTaps );
185 : }
186 770 : for ( ; bandIdx < 30; bandIdx++ )
187 : {
188 700 : hBinRenConvModule->numTapsArray[bandIdx] = (int16_t) ceilf( 0.4f * hBinRenConvModule->numTaps );
189 : }
190 1340 : for ( ; bandIdx < hBinRenderer->conv_band; bandIdx++ )
191 : {
192 1270 : hBinRenConvModule->numTapsArray[bandIdx] = (int16_t) ceilf( 0.3f * hBinRenConvModule->numTaps );
193 : }
194 : }
195 : else
196 : {
197 : /* Use fixed order filtering */
198 692 : bandIdx = 0;
199 32452 : for ( ; bandIdx < hBinRenderer->conv_band; bandIdx++ )
200 : {
201 31760 : hBinRenConvModule->numTapsArray[bandIdx] = hBinRenConvModule->numTaps;
202 : }
203 : }
204 :
205 : /* allocate memory for filter states */
206 762 : 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 762 : 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 762 : 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 762 : 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 35862 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
227 : {
228 35100 : 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 35100 : 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 35100 : 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 35100 : 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 762 : 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 762 : 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 2396 : for ( pos_idx = 0; pos_idx < num_poses; pos_idx++ )
260 : {
261 1634 : 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 1634 : 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 80334 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
272 : {
273 78700 : 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 78700 : 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 1248180 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
284 : {
285 1169480 : 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 1169480 : 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 35862 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
300 : {
301 506980 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
302 : {
303 471880 : int16_t tmp = 0;
304 :
305 471880 : tmp = chIdx;
306 471880 : if ( isLoudspeaker )
307 : {
308 48200 : if ( input_config == IVAS_AUDIO_CONFIG_5_1 )
309 : {
310 38650 : tmp = channelIndex_CICP6[chIdx];
311 : }
312 9550 : else if ( input_config == IVAS_AUDIO_CONFIG_7_1 )
313 : {
314 0 : tmp = channelIndex_CICP12[chIdx];
315 : }
316 9550 : else if ( input_config == IVAS_AUDIO_CONFIG_5_1_2 )
317 : {
318 420 : tmp = channelIndex_CICP14[chIdx];
319 : }
320 9130 : else if ( input_config == IVAS_AUDIO_CONFIG_5_1_4 )
321 : {
322 0 : tmp = channelIndex_CICP16[chIdx];
323 : }
324 9130 : else if ( input_config == IVAS_AUDIO_CONFIG_7_1_4 )
325 : {
326 9130 : 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 471880 : hBinRenConvModule->filterTapsLeftReal[bandIdx][chIdx] = hHrtf->leftReal[bandIdx][tmp];
337 471880 : hBinRenConvModule->filterTapsLeftImag[bandIdx][chIdx] = hHrtf->leftImag[bandIdx][tmp];
338 471880 : hBinRenConvModule->filterTapsRightReal[bandIdx][chIdx] = hHrtf->rightReal[bandIdx][tmp];
339 471880 : hBinRenConvModule->filterTapsRightImag[bandIdx][chIdx] = hHrtf->rightImag[bandIdx][tmp];
340 : }
341 : }
342 :
343 2396 : for ( pos_idx = 0; pos_idx < num_poses; pos_idx++ )
344 : {
345 80334 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
346 : {
347 1248180 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
348 : {
349 : /* set the memories to zero */
350 1169480 : set_zero( hBinRenConvModule->filterStatesLeftReal[pos_idx][bandIdx][chIdx], hBinRenConvModule->numTapsArray[bandIdx] );
351 1169480 : set_zero( hBinRenConvModule->filterStatesLeftImag[pos_idx][bandIdx][chIdx], hBinRenConvModule->numTapsArray[bandIdx] );
352 : }
353 : }
354 : }
355 :
356 762 : hBinRenderer->hBinRenConvModule = hBinRenConvModule;
357 :
358 762 : return IVAS_ERR_OK;
359 : }
360 :
361 :
362 : /*-------------------------------------------------------------------------*
363 : * ivas_init_binaural_hrtf()
364 : *
365 : * initialize memory for HrtfFastConv structure elements
366 : *-------------------------------------------------------------------------*/
367 :
368 442 : void ivas_init_binaural_hrtf(
369 : HRTFS_FASTCONV *HrtfFastConv /* i/o: FASTCONV HRTF structure */
370 : )
371 : {
372 : int16_t i;
373 :
374 442 : HrtfFastConv->leftReal = NULL;
375 442 : HrtfFastConv->leftImag = NULL;
376 442 : HrtfFastConv->rightReal = NULL;
377 442 : HrtfFastConv->rightImag = NULL;
378 442 : HrtfFastConv->FASTCONV_latency_s = 0x00;
379 :
380 442 : HrtfFastConv->n_channels = 0;
381 442 : HrtfFastConv->allocate_init_flag = 0x00;
382 442 : HrtfFastConv->ntaps = 0;
383 :
384 26962 : for ( i = 0; i < CLDFB_NO_CHANNELS_MAX; i++ )
385 : {
386 26520 : HrtfFastConv->fastconvReverberationEneCorrections[i] = 0x00;
387 26520 : HrtfFastConv->fastconvReverberationEneCorrections[i] = 0x00;
388 : }
389 :
390 442 : return;
391 : }
392 :
393 :
394 : /*-------------------------------------------------------------------------*
395 : * ivas_alloc_pppMem()
396 : *
397 : * Allocate memory for tripple pointer elements
398 : *-------------------------------------------------------------------------*/
399 :
400 1768 : 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 1768 : float ***localMem = NULL;
409 :
410 1768 : 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 90168 : for ( i = 0; i < dim1; i++ )
416 : {
417 88400 : 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 88400 : if ( allocate_init_flag == 0 )
422 : {
423 229800 : for ( j = 0; j < dim2; j++ )
424 : {
425 216200 : 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 1768 : *pppMem = localMem;
434 :
435 1768 : return IVAS_ERR_OK;
436 : }
437 :
438 :
439 : /*-------------------------------------------------------------------------*
440 : * ivas_allocate_binaural_hrtf()
441 : *
442 : * Allocate memory for HrtfFastConv structure elements
443 : *-------------------------------------------------------------------------*/
444 :
445 447 : 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 447 : HrtfFastConv->n_channels = n_channels;
452 :
453 447 : if ( ( HrtfFastConv->leftReal != NULL ) && ( HrtfFastConv->leftImag != NULL ) && ( HrtfFastConv->rightReal != NULL ) && ( HrtfFastConv->rightImag != NULL ) )
454 : {
455 5 : return IVAS_ERR_OK;
456 : }
457 : else
458 : {
459 442 : 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 442 : 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 442 : 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 442 : 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 442 : return IVAS_ERR_OK;
478 : }
479 :
480 :
481 : /*-------------------------------------------------------------------------*
482 : * ivas_binaural_hrtf_open()
483 : *
484 : *
485 : *-------------------------------------------------------------------------*/
486 :
487 762 : 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 762 : if ( hHrtfFastConv != NULL && *hHrtfFastConv != NULL )
498 : {
499 : /* Tables already loaded from file */
500 388 : return IVAS_ERR_OK;
501 : }
502 : else
503 : {
504 : /* Initialise tables from ROM */
505 : HRTFS_FASTCONV *HrtfFastConv;
506 :
507 374 : 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 374 : ivas_init_binaural_hrtf( HrtfFastConv );
513 :
514 374 : if ( input_config == IVAS_AUDIO_CONFIG_BINAURAL || renderer_type == RENDERER_BINAURAL_FASTCONV )
515 : {
516 360 : HrtfFastConv->FASTCONV_latency_s = FASTCONV_HRIR_latency_s;
517 360 : HrtfFastConv->ntaps = BINAURAL_NTAPS;
518 : }
519 374 : 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 374 : if ( input_config == IVAS_AUDIO_CONFIG_HOA3 )
525 : {
526 361 : HrtfFastConv->FASTCONV_latency_s = FASTCONV_HOA3_latency_s;
527 361 : HrtfFastConv->ntaps = BINAURAL_NTAPS_SBA;
528 : }
529 374 : 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 374 : if ( input_config == IVAS_AUDIO_CONFIG_BINAURAL || renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM )
535 : {
536 14 : HrtfFastConv->FASTCONV_latency_s = FASTCONV_BRIR_latency_s;
537 14 : HrtfFastConv->ntaps = BINAURAL_NTAPS_MAX;
538 : }
539 :
540 374 : HrtfFastConv->allocate_init_flag = 1;
541 :
542 374 : n_channels = 0;
543 374 : if ( ( renderer_type == RENDERER_BINAURAL_FASTCONV || renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM ) && input_config != IVAS_AUDIO_CONFIG_INVALID )
544 : {
545 374 : n_channels = HRTF_LS_CHANNELS;
546 : }
547 :
548 374 : if ( renderer_type == RENDERER_BINAURAL_FASTCONV )
549 : {
550 360 : if ( input_config == IVAS_AUDIO_CONFIG_HOA3 )
551 : {
552 354 : n_channels = HOA3_CHANNELS;
553 : }
554 6 : else if ( input_config == IVAS_AUDIO_CONFIG_HOA2 )
555 : {
556 0 : n_channels = HOA2_CHANNELS;
557 : }
558 6 : else if ( input_config == IVAS_AUDIO_CONFIG_FOA )
559 : {
560 0 : n_channels = FOA_CHANNELS;
561 : }
562 : }
563 :
564 374 : if ( ( error = ivas_allocate_binaural_hrtf( HrtfFastConv, n_channels, HrtfFastConv->allocate_init_flag ) ) != IVAS_ERR_OK )
565 : {
566 0 : return error;
567 : }
568 :
569 19074 : for ( i = 0; i < BINAURAL_CONVBANDS; i++ )
570 : {
571 18700 : if ( renderer_type == RENDERER_BINAURAL_FASTCONV && HrtfFastConv->n_channels == HRTF_LS_CHANNELS )
572 : {
573 4800 : for ( j = 0; j < HRTF_LS_CHANNELS; j++ )
574 : {
575 4500 : HrtfFastConv->leftReal[i][j] = leftHRIRReal[i][j];
576 4500 : HrtfFastConv->leftImag[i][j] = leftHRIRImag[i][j];
577 4500 : HrtfFastConv->rightReal[i][j] = rightHRIRReal[i][j];
578 4500 : HrtfFastConv->rightImag[i][j] = rightHRIRImag[i][j];
579 : }
580 : }
581 18400 : else if ( renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM && HrtfFastConv->n_channels == HRTF_LS_CHANNELS )
582 : {
583 11200 : for ( j = 0; j < HRTF_LS_CHANNELS; j++ )
584 : {
585 10500 : HrtfFastConv->leftReal[i][j] = leftBRIRReal[i][j];
586 10500 : HrtfFastConv->leftImag[i][j] = leftBRIRImag[i][j];
587 10500 : HrtfFastConv->rightReal[i][j] = rightBRIRReal[i][j];
588 10500 : HrtfFastConv->rightImag[i][j] = rightBRIRImag[i][j];
589 : }
590 : }
591 :
592 18700 : if ( input_config == IVAS_AUDIO_CONFIG_HOA3 && HrtfFastConv->n_channels == HOA3_CHANNELS )
593 : {
594 300900 : for ( j = 0; j < HOA3_CHANNELS; j++ )
595 : {
596 283200 : HrtfFastConv->leftReal[i][j] = leftHRIRReal_HOA3[i][j];
597 283200 : HrtfFastConv->leftImag[i][j] = leftHRIRImag_HOA3[i][j];
598 283200 : HrtfFastConv->rightReal[i][j] = rightHRIRReal_HOA3[i][j];
599 283200 : 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 18700 : 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 18700 : 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 374 : mvr2r( fastconvReverberationTimes, HrtfFastConv->fastconvReverberationTimes, CLDFB_NO_CHANNELS_MAX );
629 374 : mvr2r( fastconvReverberationEneCorrections, HrtfFastConv->fastconvReverberationEneCorrections, CLDFB_NO_CHANNELS_MAX );
630 :
631 374 : *hHrtfFastConv = HrtfFastConv;
632 :
633 374 : return IVAS_ERR_OK;
634 : }
635 : }
636 :
637 :
638 : /*-------------------------------------------------------------------------*
639 : * ivas_binaural_obtain_DMX()
640 : *
641 : *
642 : *-------------------------------------------------------------------------*/
643 :
644 104850 : 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 104850 : 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 157200 : for ( k = 0; k < numTimeSlots; k++ )
663 : {
664 377280 : for ( chOutIdx = 0; chOutIdx < BINAURAL_CHANNELS; chOutIdx++ )
665 : {
666 251520 : set_zero( realDMX[chOutIdx][k], CLDFB_NO_CHANNELS_MAX );
667 251520 : set_zero( imagDMX[chOutIdx][k], CLDFB_NO_CHANNELS_MAX );
668 : }
669 : }
670 :
671 94320 : for ( chOutIdx = 0; chOutIdx < BINAURAL_CHANNELS; chOutIdx++ )
672 : {
673 62880 : set_zero( P_in, hBinRenderer->conv_band );
674 :
675 576960 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
676 : {
677 514080 : float dmxConst = dmxmtx_table[chOutIdx][chIdx];
678 :
679 24879680 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
680 : {
681 121828000 : for ( k = 0; k < numTimeSlots; k++ )
682 : {
683 97462400 : temp1 = RealBuffer[chIdx][k][bandIdx] * dmxConst;
684 97462400 : temp2 = ImagBuffer[chIdx][k][bandIdx] * dmxConst;
685 97462400 : realDMX[chOutIdx][k][bandIdx] += temp1;
686 97462400 : imagDMX[chOutIdx][k][bandIdx] += temp2;
687 :
688 97462400 : P_in[bandIdx] += temp1 * temp1 + temp2 * temp2;
689 : }
690 : }
691 : }
692 :
693 3038080 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
694 : {
695 2975200 : P_out = 0.f;
696 14876000 : for ( k = 0; k < numTimeSlots; k++ )
697 : {
698 11900800 : temp1 = realDMX[chOutIdx][k][bandIdx];
699 11900800 : temp2 = imagDMX[chOutIdx][k][bandIdx];
700 11900800 : P_out += temp1 * temp1 + temp2 * temp2;
701 : }
702 2975200 : factEQ = sqrtf( P_in[bandIdx] / ( P_out + 1e-20f ) );
703 2975200 : if ( ( factEQ <= 1e-20f ) || ( P_in[bandIdx] <= 1e-20f ) || ( P_out <= 1e-20f ) )
704 : {
705 37064 : factEQ = 1.0f;
706 : }
707 :
708 2975200 : factEQ = max( min( factEQ, 2.0f ), 0.5f );
709 14876000 : for ( k = 0; k < numTimeSlots; k++ )
710 : {
711 11900800 : realDMX[chOutIdx][k][bandIdx] *= factEQ;
712 11900800 : imagDMX[chOutIdx][k][bandIdx] *= factEQ;
713 : }
714 : }
715 : }
716 : }
717 73410 : 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 366449 : for ( k = 0; k < numTimeSlots; k++ )
724 : {
725 293039 : outRealLeftPtr = realDMX[0][k];
726 293039 : outImagLeftPtr = imagDMX[0][k];
727 293039 : outRealRightPtr = realDMX[1][k];
728 293039 : outImagRightPtr = imagDMX[1][k];
729 293039 : set_zero( outRealLeftPtr, CLDFB_NO_CHANNELS_MAX );
730 293039 : set_zero( outImagLeftPtr, CLDFB_NO_CHANNELS_MAX );
731 293039 : set_zero( outRealRightPtr, CLDFB_NO_CHANNELS_MAX );
732 293039 : set_zero( outImagRightPtr, CLDFB_NO_CHANNELS_MAX );
733 :
734 : /*Ambisonics input requires different processing*/
735 293039 : if ( hBinRenderer->nInChannels == HOA3_CHANNELS )
736 : {
737 : float *inRealPtr_W, *inImagPtr_W;
738 : float *inRealPtr_Y, *inImagPtr_Y;
739 :
740 181055 : inRealPtr_W = (float *) &( RealBuffer[0][k][0] );
741 181055 : inImagPtr_W = (float *) &( ImagBuffer[0][k][0] );
742 :
743 181055 : inRealPtr_Y = (float *) &( RealBuffer[1][k][0] );
744 181055 : inImagPtr_Y = (float *) &( ImagBuffer[1][k][0] );
745 :
746 8032175 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
747 : {
748 7851120 : outRealLeftPtr[bandIdx] = inRealPtr_W[bandIdx] + inRealPtr_Y[bandIdx];
749 7851120 : outImagLeftPtr[bandIdx] = inImagPtr_W[bandIdx] + inImagPtr_Y[bandIdx];
750 :
751 7851120 : outRealRightPtr[bandIdx] = inRealPtr_W[bandIdx] - inRealPtr_Y[bandIdx];
752 7851120 : outImagRightPtr[bandIdx] = inImagPtr_W[bandIdx] - inImagPtr_Y[bandIdx];
753 : }
754 : }
755 : else
756 : {
757 1343808 : for ( chIdx = 0; chIdx < hBinRenderer->nInChannels; chIdx++ )
758 : {
759 1231824 : float foa_const = hBinRenderer->hReverb->foa_enc[chIdx][1];
760 :
761 1231824 : inRealPtr = (float *) &( RealBuffer[chIdx][k][0] );
762 1231824 : inImagPtr = (float *) &( ImagBuffer[chIdx][k][0] );
763 :
764 52263024 : for ( bandIdx = 0; bandIdx < hBinRenderer->conv_band; bandIdx++ )
765 : {
766 51031200 : outRealLeftPtr[bandIdx] += inRealPtr[bandIdx] * ( 1.f + foa_const );
767 51031200 : outImagLeftPtr[bandIdx] += inImagPtr[bandIdx] * ( 1.f + foa_const );
768 :
769 51031200 : outRealRightPtr[bandIdx] += inRealPtr[bandIdx] * ( 1.f - foa_const );
770 51031200 : outImagRightPtr[bandIdx] += inImagPtr[bandIdx] * ( 1.f - foa_const );
771 : }
772 : }
773 : }
774 : }
775 : }
776 :
777 104850 : 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 762 : 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 762 : 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 762 : hBinRenderer->hInputSetup = &st_ivas->hIntSetup;
896 :
897 : /* Define of head rotation has to be done in binRendeder in CLDFB*/
898 762 : hBinRenderer->rotInCldfb = 0;
899 762 : if ( st_ivas->ivas_format == MC_FORMAT || st_ivas->ivas_format == SBA_FORMAT || st_ivas->ivas_format == SBA_ISM_FORMAT )
900 : {
901 762 : hBinRenderer->rotInCldfb = 1;
902 : }
903 :
904 762 : 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 326 : hBinRenderer->numPoses = st_ivas->hSplitBinRend->splitrend.multiBinPoseData.num_poses;
910 : #endif
911 : }
912 : else
913 : {
914 436 : 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 762 : if ( st_ivas->hIntSetup.is_loudspeaker_setup )
920 : {
921 201 : hBinRenderer->ivas_format = MC_FORMAT;
922 : }
923 : else
924 : {
925 561 : hBinRenderer->ivas_format = SBA_FORMAT;
926 : }
927 762 : hBinRenderer->max_band = (int16_t) ( ( BINAURAL_MAXBANDS * st_ivas->hDecoderConfig->output_Fs ) / 48000 );
928 762 : convBand = hBinRenderer->max_band;
929 :
930 762 : hBinRenderer->timeSlots = MAX_PARAM_SPATIAL_SUBFRAMES; /* Corresponds to 5 msec sound to motion latency */
931 :
932 762 : if ( convBand > BINAURAL_CONVBANDS )
933 : {
934 634 : hBinRenderer->conv_band = BINAURAL_CONVBANDS;
935 : }
936 : else
937 : {
938 128 : hBinRenderer->conv_band = convBand;
939 : }
940 :
941 : /*LFE rendering switched off by default*/
942 762 : hBinRenderer->render_lfe = 0;
943 :
944 762 : if ( st_ivas->ivas_format != ISM_FORMAT && st_ivas->hIntSetup.is_loudspeaker_setup )
945 : {
946 201 : hBinRenderer->render_lfe = 1;
947 : }
948 :
949 762 : 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 762 : 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 762 : if ( st_ivas->renderer_type == RENDERER_BINAURAL_FASTCONV_ROOM && ( st_ivas->hIntSetup.is_loudspeaker_setup == 0 ) )
961 7 : {
962 : IVAS_OUTPUT_SETUP out_setup;
963 :
964 : /* Allocate memories and buffers needed for convolutional module in CICP19 */
965 7 : 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 7 : ivas_output_init( &out_setup, IVAS_AUDIO_CONFIG_7_1_4 );
971 :
972 7 : if ( st_ivas->hoa_dec_mtx == NULL )
973 : {
974 7 : 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 7 : hBinRenderer->hoa_dec_mtx = st_ivas->hoa_dec_mtx;
981 7 : 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 755 : 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 755 : 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 762 : 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 193 : pRoomAcoustics = ( st_ivas->hOutSetup.output_config == IVAS_AUDIO_CONFIG_BINAURAL_ROOM_REVERB ) ? &( st_ivas->hRenderConfig->roomAcoustics ) : NULL;
998 :
999 193 : if ( ( error = ivas_binaural_reverb_init( &( hBinRenderer->hReverb ),
1000 : st_ivas->hHrtfStatistics,
1001 193 : hBinRenderer->conv_band,
1002 193 : hBinRenderer->timeSlots,
1003 : pRoomAcoustics,
1004 193 : st_ivas->hDecoderConfig->output_Fs,
1005 193 : st_ivas->hHrtfFastConv->fastconvReverberationTimes,
1006 193 : st_ivas->hHrtfFastConv->fastconvReverberationEneCorrections,
1007 : NULL ) ) != IVAS_ERR_OK )
1008 :
1009 : {
1010 0 : return error;
1011 : }
1012 : }
1013 : else
1014 : {
1015 569 : hBinRenderer->hReverb = NULL;
1016 : }
1017 :
1018 762 : hBinRenderer->hEFAPdata = NULL;
1019 :
1020 762 : if ( hBinRenderer->hReverb != NULL && hBinRenderer->nInChannels != HOA3_CHANNELS )
1021 : {
1022 126 : if ( hBinRenderer->hInputSetup->is_loudspeaker_setup == 0 )
1023 : {
1024 84 : for ( k = 0; k < 11; k++ )
1025 : {
1026 77 : 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 119 : 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 2 : 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 2 : hBinRenderer->hEFAPdata = st_ivas->hEFAPdata;
1042 : }
1043 : }
1044 :
1045 : /* Copy the handles to main handle */
1046 762 : st_ivas->hBinRenderer = hBinRenderer;
1047 :
1048 762 : 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 762 : 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 762 : hBinRenConvModule = ( *hBinRenderer )->hBinRenConvModule;
1068 :
1069 762 : if ( hBinRenConvModule == NULL )
1070 : {
1071 0 : return;
1072 : }
1073 :
1074 35862 : for ( bandIdx = 0; bandIdx < ( *hBinRenderer )->conv_band; bandIdx++ )
1075 : {
1076 35100 : free( hBinRenConvModule->filterTapsLeftReal[bandIdx] );
1077 35100 : hBinRenConvModule->filterTapsLeftReal[bandIdx] = NULL;
1078 :
1079 35100 : free( hBinRenConvModule->filterTapsLeftImag[bandIdx] );
1080 35100 : hBinRenConvModule->filterTapsLeftImag[bandIdx] = NULL;
1081 :
1082 35100 : free( hBinRenConvModule->filterTapsRightReal[bandIdx] );
1083 35100 : hBinRenConvModule->filterTapsRightReal[bandIdx] = NULL;
1084 :
1085 35100 : free( hBinRenConvModule->filterTapsRightImag[bandIdx] );
1086 35100 : hBinRenConvModule->filterTapsRightImag[bandIdx] = NULL;
1087 : }
1088 :
1089 762 : free( hBinRenConvModule->filterTapsLeftReal );
1090 762 : hBinRenConvModule->filterTapsLeftReal = NULL;
1091 :
1092 762 : free( hBinRenConvModule->filterTapsLeftImag );
1093 762 : hBinRenConvModule->filterTapsLeftImag = NULL;
1094 :
1095 762 : free( hBinRenConvModule->filterTapsRightReal );
1096 762 : hBinRenConvModule->filterTapsRightReal = NULL;
1097 :
1098 762 : free( hBinRenConvModule->filterTapsRightImag );
1099 762 : hBinRenConvModule->filterTapsRightImag = NULL;
1100 :
1101 2396 : for ( posIdx = 0; posIdx < num_poses; posIdx++ )
1102 : {
1103 80334 : for ( bandIdx = 0; bandIdx < ( *hBinRenderer )->conv_band; bandIdx++ )
1104 : {
1105 1248180 : for ( chIdx = 0; chIdx < ( *hBinRenderer )->nInChannels; chIdx++ )
1106 : {
1107 1169480 : free( hBinRenConvModule->filterStatesLeftReal[posIdx][bandIdx][chIdx] );
1108 1169480 : hBinRenConvModule->filterStatesLeftReal[posIdx][bandIdx][chIdx] = NULL;
1109 :
1110 1169480 : free( hBinRenConvModule->filterStatesLeftImag[posIdx][bandIdx][chIdx] );
1111 1169480 : hBinRenConvModule->filterStatesLeftImag[posIdx][bandIdx][chIdx] = NULL;
1112 : }
1113 :
1114 78700 : free( hBinRenConvModule->filterStatesLeftReal[posIdx][bandIdx] );
1115 78700 : hBinRenConvModule->filterStatesLeftReal[posIdx][bandIdx] = NULL;
1116 :
1117 78700 : free( hBinRenConvModule->filterStatesLeftImag[posIdx][bandIdx] );
1118 78700 : hBinRenConvModule->filterStatesLeftImag[posIdx][bandIdx] = NULL;
1119 : }
1120 :
1121 1634 : free( hBinRenConvModule->filterStatesLeftReal[posIdx] );
1122 1634 : hBinRenConvModule->filterStatesLeftReal[posIdx] = NULL;
1123 :
1124 1634 : free( hBinRenConvModule->filterStatesLeftImag[posIdx] );
1125 1634 : hBinRenConvModule->filterStatesLeftImag[posIdx] = NULL;
1126 : }
1127 762 : free( hBinRenConvModule->filterStatesLeftReal );
1128 762 : hBinRenConvModule->filterStatesLeftReal = NULL;
1129 :
1130 762 : free( hBinRenConvModule->filterStatesLeftImag );
1131 762 : hBinRenConvModule->filterStatesLeftImag = NULL;
1132 :
1133 762 : free( ( *hBinRenderer )->hBinRenConvModule );
1134 762 : ( *hBinRenderer )->hBinRenConvModule = NULL;
1135 :
1136 762 : return;
1137 : }
1138 :
1139 :
1140 : /*-------------------------------------------------------------------------
1141 : * ivas_binRenderer_close()
1142 : *
1143 : * Close fastconv binaural renderer memories
1144 : *------------------------------------------------------------------------*/
1145 :
1146 2057 : void ivas_binRenderer_close(
1147 : BINAURAL_RENDERER_HANDLE *hBinRenderer /* i/o: fastconv binaural renderer handle */
1148 : )
1149 : {
1150 2057 : if ( hBinRenderer == NULL || *hBinRenderer == NULL )
1151 : {
1152 1295 : return;
1153 : }
1154 :
1155 762 : if ( ( *hBinRenderer )->hBinRenConvModule != NULL )
1156 : {
1157 762 : ivas_binRenderer_convModuleClose( hBinRenderer, ( *hBinRenderer )->numPoses );
1158 : }
1159 :
1160 762 : if ( ( *hBinRenderer )->hReverb != NULL )
1161 : {
1162 193 : ivas_binaural_reverb_close( &( ( *hBinRenderer )->hReverb ) );
1163 : }
1164 :
1165 762 : free( *hBinRenderer );
1166 762 : *hBinRenderer = NULL;
1167 :
1168 762 : return;
1169 : }
1170 :
1171 :
1172 : /*-------------------------------------------------------------------------
1173 : * ivas_free_pppHrtfMem()
1174 : *
1175 : * Free fastconv binaural renderer hrtf memories
1176 : *------------------------------------------------------------------------*/
1177 :
1178 1768 : 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 1768 : if ( *ppppHRIR != NULL )
1186 : {
1187 90168 : for ( i = 0; i < BINAURAL_CONVBANDS; i++ )
1188 : {
1189 88400 : if ( alloc_init == 0 )
1190 : {
1191 229800 : for ( j = 0; j < dim; j++ )
1192 : {
1193 216200 : free( ( *ppppHRIR )[i][j] );
1194 216200 : ( *ppppHRIR )[i][j] = NULL;
1195 : }
1196 : }
1197 88400 : free( ( *ppppHRIR )[i] );
1198 88400 : ( *ppppHRIR )[i] = NULL;
1199 : }
1200 1768 : free( *ppppHRIR );
1201 1768 : *ppppHRIR = NULL;
1202 : }
1203 :
1204 1768 : return;
1205 : }
1206 :
1207 :
1208 : /*-------------------------------------------------------------------------
1209 : * ivas_binaural_hrtf_close()
1210 : *
1211 : * Close fastconv binaural renderer hrtf memories
1212 : *------------------------------------------------------------------------*/
1213 :
1214 2484 : 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 2484 : if ( hHrtfFastConv == NULL || *hHrtfFastConv == NULL )
1222 : {
1223 2042 : return;
1224 : }
1225 :
1226 442 : allocate_init_flag = ( *hHrtfFastConv )->allocate_init_flag;
1227 442 : n_channels = ( *hHrtfFastConv )->n_channels;
1228 :
1229 442 : ivas_free_pppHrtfMem( &( *hHrtfFastConv )->leftReal, n_channels, allocate_init_flag );
1230 442 : ivas_free_pppHrtfMem( &( *hHrtfFastConv )->leftImag, n_channels, allocate_init_flag );
1231 442 : ivas_free_pppHrtfMem( &( *hHrtfFastConv )->rightReal, n_channels, allocate_init_flag );
1232 442 : ivas_free_pppHrtfMem( &( *hHrtfFastConv )->rightImag, n_channels, allocate_init_flag );
1233 :
1234 442 : 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 165365 : 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 165365 : if ( st_ivas->hBinRenderer != NULL )
1256 : {
1257 160 : render_lfe = st_ivas->hBinRenderer->render_lfe;
1258 : }
1259 : else
1260 : {
1261 165205 : render_lfe = TRUE;
1262 : }
1263 :
1264 165365 : if ( render_lfe )
1265 : {
1266 165365 : if ( st_ivas->renderer_type == RENDERER_BINAURAL_OBJECTS_TD )
1267 : {
1268 151225 : gain = GAIN_LFE;
1269 : }
1270 : else
1271 : {
1272 14140 : gain = ( ( st_ivas->hCrendWrapper != NULL ) && ( st_ivas->hCrendWrapper->hHrtfCrend != NULL ) ) ? st_ivas->hCrendWrapper->hHrtfCrend->gain_lfe : GAIN_LFE;
1273 : }
1274 :
1275 330517 : for ( idx_lfe = 0; idx_lfe < st_ivas->hIntSetup.num_lfe; idx_lfe++ )
1276 : {
1277 165152 : 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 165152 : v_add( output_f[0], lfe_tc, output_f[0], output_frame );
1280 165152 : v_add( output_f[1], lfe_tc, output_f[1], output_frame );
1281 : }
1282 : }
1283 :
1284 165365 : return;
1285 : }
1286 :
1287 :
1288 : /*-------------------------------------------------------------------------
1289 : * ivas_binRenderer()
1290 : *
1291 : * Fastconv binaural renderer main function
1292 : *-------------------------------------------------------------------------*/
1293 :
1294 480610 : 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 480610 : push_wmops( "fastconv_binaural_rendering" );
1314 480610 : num_poses = hBinRenderer->numPoses;
1315 :
1316 : /* Compute Convolution */
1317 : /* memory reset for the binaural output */
1318 1788714 : for ( pos_idx = 0; pos_idx < num_poses; pos_idx++ )
1319 : {
1320 3924312 : for ( chIdx = 0; chIdx < BINAURAL_CHANNELS; chIdx++ )
1321 : {
1322 12691508 : for ( k = 0; k < numTimeSlots; k++ )
1323 : {
1324 10075300 : set_zero( Cldfb_RealBuffer_Binaural[pos_idx][chIdx][k], CLDFB_NO_CHANNELS_MAX );
1325 10075300 : set_zero( Cldfb_ImagBuffer_Binaural[pos_idx][chIdx][k], CLDFB_NO_CHANNELS_MAX );
1326 : }
1327 : }
1328 : }
1329 :
1330 7851874 : for ( chIdx = 0; chIdx < hBinRenderer->hInputSetup->nchan_out_woLFE; chIdx++ )
1331 : {
1332 35865696 : for ( k = 0; k < numTimeSlots; k++ )
1333 : {
1334 28494432 : mvr2r( RealBuffer[chIdx][k], RealBuffer_local[chIdx][k], CLDFB_NO_CHANNELS_MAX );
1335 28494432 : mvr2r( ImagBuffer[chIdx][k], ImagBuffer_local[chIdx][k], CLDFB_NO_CHANNELS_MAX );
1336 : }
1337 : }
1338 :
1339 : /* Head rotation in HOA3 or CICPx */
1340 480610 : if ( hCombinedOrientationData != NULL && hCombinedOrientationData->enableCombinedOrientation[hCombinedOrientationData->subframe_idx] && hBinRenderer->rotInCldfb )
1341 : {
1342 380307 : if ( hBinRenderer->hInputSetup->is_loudspeaker_setup == 0 )
1343 : {
1344 : /* Rotation in SHD (HOA3) */
1345 372307 : if ( hCombinedOrientationData->shd_rot_max_order == -1 )
1346 : {
1347 134290 : rotateFrame_shd_cldfb( RealBuffer, ImagBuffer, hCombinedOrientationData->Rmat[hCombinedOrientationData->subframe_idx], hBinRenderer->hInputSetup->nchan_out_woLFE, numTimeSlots, 3 );
1348 : }
1349 238017 : else if ( hCombinedOrientationData->shd_rot_max_order > 0 )
1350 : {
1351 34604 : 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 8000 : 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 480610 : if ( hBinRenderer->hInputSetup->is_loudspeaker_setup == 0 &&
1363 442514 : ( hBinRenderer->nInChannels != HOA3_CHANNELS && hBinRenderer->nInChannels != HOA2_CHANNELS && hBinRenderer->nInChannels != FOA_CHANNELS ) )
1364 : {
1365 27996 : ivas_sba2mc_cldfb( *( hBinRenderer->hInputSetup ), RealBuffer, ImagBuffer, hBinRenderer->nInChannels, hBinRenderer->conv_band, numTimeSlots, hBinRenderer->hoa_dec_mtx );
1366 : }
1367 :
1368 480610 : ivas_binRenderer_filterModule( Cldfb_RealBuffer_Binaural[0], Cldfb_ImagBuffer_Binaural[0], RealBuffer, ImagBuffer, numTimeSlots, hBinRenderer, 0 );
1369 :
1370 480610 : if ( pMultiBinPoseData != NULL )
1371 : {
1372 316196 : if ( pMultiBinPoseData->num_poses > 1 )
1373 : {
1374 : IVAS_QUATERNION Quaternions_rel, Quaternions_abs, *Quaternions_ref;
1375 : float Rmat_local[3][3];
1376 :
1377 202977 : if ( hCombinedOrientationData && hBinRenderer->rotInCldfb )
1378 : {
1379 202977 : Quaternions_ref = &hCombinedOrientationData->Quaternions[0];
1380 202977 : Quaternions_rel.w = -3.0f; /*euler*/
1381 202977 : Quaternions_abs.w = -3.0f;
1382 :
1383 202977 : if ( hCombinedOrientationData->shd_rot_max_order == 0 )
1384 : {
1385 : /*HOA signal already rotated by DirAC*/
1386 97389 : Quaternions_abs.x = 0.0f;
1387 97389 : Quaternions_abs.y = 0.0f;
1388 97389 : Quaternions_abs.z = 0.0f;
1389 : }
1390 : else
1391 : {
1392 : /*euler*/
1393 105588 : Quat2EulerDegree( *Quaternions_ref, &Quaternions_abs.z, &Quaternions_abs.y, &Quaternions_abs.x ); /*order in Quat2Euler seems to be reversed ?*/
1394 : }
1395 :
1396 1030471 : for ( pos_idx = 1; pos_idx < pMultiBinPoseData->num_poses; pos_idx++ )
1397 : {
1398 14067398 : for ( chIdx = 0; chIdx < hBinRenderer->hInputSetup->nchan_out_woLFE; chIdx++ )
1399 : {
1400 64073888 : for ( k = 0; k < numTimeSlots; k++ )
1401 : {
1402 50833984 : mvr2r( RealBuffer_local[chIdx][k], RealBuffer[chIdx][k], CLDFB_NO_CHANNELS_MAX );
1403 50833984 : mvr2r( ImagBuffer_local[chIdx][k], ImagBuffer[chIdx][k], CLDFB_NO_CHANNELS_MAX );
1404 : }
1405 : }
1406 827494 : Quaternions_rel.x = pMultiBinPoseData->relative_head_poses[pos_idx][0] - pMultiBinPoseData->relative_head_poses[pos_idx - 1][0];
1407 827494 : Quaternions_rel.y = pMultiBinPoseData->relative_head_poses[pos_idx][1] - pMultiBinPoseData->relative_head_poses[pos_idx - 1][1];
1408 827494 : Quaternions_rel.z = pMultiBinPoseData->relative_head_poses[pos_idx][2] - pMultiBinPoseData->relative_head_poses[pos_idx - 1][2];
1409 827494 : Quaternions_abs.x = Quaternions_abs.x + Quaternions_rel.x;
1410 827494 : Quaternions_abs.y = Quaternions_abs.y + Quaternions_rel.y;
1411 827494 : Quaternions_abs.z = Quaternions_abs.z + Quaternions_rel.z;
1412 :
1413 827494 : QuatToRotMat( Quaternions_abs, Rmat_local );
1414 :
1415 827494 : 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 827494 : rotateFrame_shd_cldfb( RealBuffer, ImagBuffer, Rmat_local, hBinRenderer->hInputSetup->nchan_out_woLFE, numTimeSlots, hBinRenderer->hInputSetup->ambisonics_order );
1422 : }
1423 :
1424 827494 : 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 480610 : 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 104850 : ivas_binaural_obtain_DMX( numTimeSlots, hBinRenderer, RealBuffer, ImagBuffer, inRe, inIm );
1439 :
1440 314550 : for ( chIdx = 0; chIdx < BINAURAL_CHANNELS; chIdx++ )
1441 : {
1442 1047298 : for ( k = 0; k < numTimeSlots; k++ )
1443 : {
1444 837598 : set_zero( reverbRe[chIdx][k], hBinRenderer->max_band );
1445 837598 : set_zero( reverbIm[chIdx][k], hBinRenderer->max_band );
1446 : }
1447 : }
1448 :
1449 104850 : ivas_binaural_reverb_processSubframe( hBinRenderer->hReverb, BINAURAL_CHANNELS, numTimeSlots, inRe, inIm, reverbRe, reverbIm );
1450 :
1451 : /* Add the conv module and reverb module output */
1452 314550 : for ( chIdx = 0; chIdx < BINAURAL_CHANNELS; chIdx++ )
1453 : {
1454 1047298 : for ( k = 0; k < numTimeSlots; k++ )
1455 : {
1456 1675196 : 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 837598 : v_add( Cldfb_RealBuffer_Binaural[pos_idx][chIdx][k], reverbRe[chIdx][k], Cldfb_RealBuffer_Binaural[pos_idx][chIdx][k], hBinRenderer->conv_band );
1460 837598 : 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 480610 : pop_wmops();
1467 480610 : 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 : }
|
