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 <assert.h>
34 : #include <stdint.h>
35 : #include "options.h"
36 : #include <math.h>
37 : #include "ivas_cnst.h"
38 : #include "ivas_rom_com.h"
39 : #include "prot_fx.h"
40 : #include "cnst.h"
41 : #include "wmc_auto.h"
42 : #include "ivas_prot_fx.h"
43 : #include "ivas_rom_com_fx.h"
44 :
45 : /*-----------------------------------------------------------------------*
46 : * Local function prototypes
47 : *-----------------------------------------------------------------------*/
48 :
49 :
50 : static UWord16 deindex_sph_idx_general_fx( const Word16 idx_sph, const Word16 no_bits, Word32 *theta_dec_fx, Word32 *phi_dec_fx, UWord16 *p_id_phi, const MC_LS_SETUP mc_format );
51 :
52 : /*-------------------------------------------------------------------------
53 : * ivas_get_hodirac_flag()
54 : *
55 : * Return flag for HO-DirAC method at high bitrates
56 : *------------------------------------------------------------------------*/
57 :
58 : /*! r: HO-DirAC flag */
59 1005164 : Word16 ivas_get_hodirac_flag_fx(
60 : const Word32 ivas_total_brate, /* i : IVAS total bitrate */
61 : const Word16 sba_order /* i : Ambisonic (SBA) order */
62 : )
63 : {
64 1005164 : test();
65 1005164 : IF( GT_16( sba_order, 1 ) && GT_32( ivas_total_brate, IVAS_256k ) )
66 : {
67 144029 : return 1;
68 : }
69 : ELSE
70 : {
71 861135 : return 0;
72 : }
73 : }
74 : /*-------------------------------------------------------------------------
75 : * ivas_dirac_sba_config()
76 : *
77 : * DirAC Configuration function; used also in MASA decoder
78 : *------------------------------------------------------------------------*/
79 6104 : ivas_error ivas_dirac_config_fx(
80 : void *st_ivas, /* i/o: IVAS encoder/decoder state structure */
81 : const Word16 enc_dec /* i : encoder or decoder flag */
82 : )
83 : {
84 : IVAS_FORMAT ivas_format;
85 : Word16 sba_order;
86 : Word16 *element_mode;
87 : Word32 ivas_total_brate;
88 : DIRAC_CONFIG_DATA_HANDLE hConfig;
89 : IVAS_QMETADATA_HANDLE hQMetaData;
90 : Word32 Fs;
91 : Word16 *band_grouping;
92 : ivas_error error;
93 : Word16 spar_dirac_split_band;
94 : IVAS_FB_MIXER_HANDLE hFbMdft;
95 : Word16 *dirac_to_spar_md_bands;
96 :
97 6104 : error = IVAS_ERR_OK;
98 6104 : move32();
99 :
100 6104 : IF( enc_dec == ENC )
101 : {
102 1861 : ivas_format = ( (Encoder_Struct *) st_ivas )->hEncoderConfig->ivas_format;
103 1861 : move32();
104 1861 : element_mode = &( (Encoder_Struct *) st_ivas )->hEncoderConfig->element_mode_init;
105 1861 : sba_order = ( (Encoder_Struct *) st_ivas )->sba_analysis_order;
106 1861 : move16();
107 1861 : ivas_total_brate = ( (Encoder_Struct *) st_ivas )->hEncoderConfig->ivas_total_brate;
108 1861 : move32();
109 1861 : Fs = ( (Encoder_Struct *) st_ivas )->hEncoderConfig->input_Fs;
110 1861 : move32();
111 1861 : band_grouping = ( (Encoder_Struct *) st_ivas )->hDirAC->band_grouping;
112 1861 : hConfig = ( (Encoder_Struct *) st_ivas )->hDirAC->hConfig;
113 1861 : hQMetaData = ( (Encoder_Struct *) st_ivas )->hQMetaData;
114 1861 : IF( ( (Encoder_Struct *) st_ivas )->hSpar != NULL )
115 : {
116 1861 : hFbMdft = ( (Encoder_Struct *) st_ivas )->hSpar->hFbMixer;
117 1861 : dirac_to_spar_md_bands = ( (Encoder_Struct *) st_ivas )->hSpar->dirac_to_spar_md_bands;
118 : }
119 : ELSE
120 : {
121 0 : hFbMdft = NULL;
122 0 : dirac_to_spar_md_bands = NULL;
123 : }
124 : }
125 : ELSE
126 : {
127 4243 : ivas_format = ( (Decoder_Struct *) st_ivas )->ivas_format;
128 4243 : element_mode = &( (Decoder_Struct *) st_ivas )->element_mode_init;
129 4243 : sba_order = ( (Decoder_Struct *) st_ivas )->sba_analysis_order;
130 4243 : move16();
131 4243 : ivas_total_brate = ( (Decoder_Struct *) st_ivas )->hDecoderConfig->ivas_total_brate;
132 4243 : move32();
133 4243 : Fs = ( (Decoder_Struct *) st_ivas )->hDecoderConfig->output_Fs;
134 4243 : move32();
135 4243 : band_grouping = ( (Decoder_Struct *) st_ivas )->hDirAC->band_grouping;
136 4243 : hConfig = ( (Decoder_Struct *) st_ivas )->hDirAC->hConfig;
137 4243 : hQMetaData = ( (Decoder_Struct *) st_ivas )->hQMetaData;
138 4243 : IF( ( (Decoder_Struct *) st_ivas )->hSpar != NULL )
139 : {
140 1140 : hFbMdft = ( (Decoder_Struct *) st_ivas )->hSpar->hFbMixer;
141 1140 : dirac_to_spar_md_bands = ( (Decoder_Struct *) st_ivas )->hSpar->dirac_to_spar_md_bands;
142 : }
143 : ELSE
144 : {
145 3103 : hFbMdft = NULL;
146 3103 : dirac_to_spar_md_bands = NULL;
147 : }
148 4243 : ( (Decoder_Struct *) st_ivas )->hDirAC->hFbMdft = hFbMdft;
149 : }
150 :
151 6104 : test();
152 6104 : IF( EQ_32( ivas_format, SBA_FORMAT ) || EQ_32( ivas_format, SBA_ISM_FORMAT ) )
153 : {
154 3001 : hConfig->nbands = IVAS_MAX_NUM_BANDS;
155 3001 : move16();
156 :
157 3001 : spar_dirac_split_band = s_min( IVAS_MAX_NUM_BANDS, SPAR_DIRAC_SPLIT_START_BAND );
158 :
159 3001 : IF( ivas_get_hodirac_flag_fx( ivas_total_brate, sba_order ) ) // add call after merge of 100861_dirac_dec
160 : {
161 312 : spar_dirac_split_band = 0;
162 312 : move16();
163 : }
164 : }
165 : ELSE
166 : {
167 3103 : hConfig->nbands = 5;
168 3103 : spar_dirac_split_band = 0;
169 :
170 3103 : move16();
171 3103 : move16();
172 : }
173 6104 : hConfig->enc_param_start_band = 0;
174 6104 : hConfig->dec_param_estim = FALSE;
175 :
176 6104 : move16();
177 6104 : move16();
178 :
179 6104 : test();
180 6104 : IF( EQ_32( ivas_format, SBA_FORMAT ) || EQ_32( ivas_format, SBA_ISM_FORMAT ) ) /* skip for MASA decoder */
181 : {
182 3001 : IF( NE_32( ( error = ivas_dirac_sba_config_fx( hQMetaData, element_mode, ivas_total_brate, sba_order, sub( hConfig->nbands, spar_dirac_split_band ),
183 : ivas_format ) ),
184 : IVAS_ERR_OK ) )
185 : {
186 0 : return error;
187 : }
188 :
189 3001 : IF( hQMetaData != NULL )
190 : {
191 3001 : if ( enc_dec == ENC )
192 : {
193 1861 : hConfig->nbands = hQMetaData->q_direction[0].cfg.nbands;
194 1861 : move16();
195 : }
196 3001 : hConfig->enc_param_start_band = add( hQMetaData->q_direction[0].cfg.start_band, spar_dirac_split_band );
197 3001 : move16();
198 : }
199 :
200 3001 : hConfig->dec_param_estim = TRUE;
201 3001 : move16();
202 3001 : if ( EQ_16( hConfig->dec_param_estim, TRUE ) )
203 : {
204 3001 : hConfig->enc_param_start_band = spar_dirac_split_band;
205 3001 : move16();
206 : }
207 :
208 3001 : IF( ivas_get_hodirac_flag_fx( ivas_total_brate, sba_order ) )
209 : {
210 312 : hConfig->dec_param_estim = FALSE;
211 312 : hConfig->enc_param_start_band = 0;
212 :
213 312 : move16();
214 312 : move16();
215 :
216 312 : set8_fx( (Word8 *) hQMetaData->twoDirBands, (Word8) 1, hQMetaData->q_direction[0].cfg.nbands );
217 312 : hQMetaData->numTwoDirBands = (UWord8) hQMetaData->q_direction[0].cfg.nbands;
218 312 : move16();
219 : }
220 : }
221 :
222 6104 : test();
223 6104 : IF( EQ_32( ivas_format, SBA_FORMAT ) || EQ_32( ivas_format, SBA_ISM_FORMAT ) )
224 : {
225 : // 100861_dirac_dec
226 3001 : ivas_dirac_config_bands_fx( band_grouping, IVAS_MAX_NUM_BANDS, (Word16) ( Fs * INV_CLDFB_BANDWIDTH + 0.5f ), dirac_to_spar_md_bands, hQMetaData->useLowerBandRes, hConfig->enc_param_start_band, hFbMdft );
227 : }
228 : ELSE
229 : {
230 3103 : ivas_dirac_config_bands_fx( band_grouping, hConfig->nbands, (Word16) ( Fs * INV_CLDFB_BANDWIDTH + 0.5f ), NULL, 0, 0, hFbMdft );
231 : }
232 :
233 6104 : return error;
234 : }
235 :
236 :
237 : /*-------------------------------------------------------------------------
238 : * ivas_dirac_sba_config_bands()
239 : *
240 : * DirAC Configuration freq. band function; used also in MASA decoder
241 : *------------------------------------------------------------------------*/
242 :
243 101847 : void ivas_dirac_config_bands_fx(
244 : Word16 *band_grouping, /* o : band grouping */
245 : const Word16 nbands, /* i : number of bands */
246 : const Word16 max_band, /* i : maximal band index +1 */
247 : Word16 *dirac_to_spar_md_bands,
248 : const Word8 useLowerBandRes,
249 : const Word16 enc_param_start_band,
250 : IVAS_FB_MIXER_HANDLE hFbMdft )
251 : {
252 : Word16 i;
253 : {
254 101847 : IF( EQ_16( nbands, 5 ) )
255 : {
256 4245 : Copy( DirAC_band_grouping_5, band_grouping, 5 + 1 );
257 : }
258 97602 : ELSE IF( EQ_16( nbands, 6 ) )
259 : {
260 0 : Copy( DirAC_band_grouping_6, band_grouping, 6 + 1 );
261 : }
262 97602 : ELSE IF( EQ_16( nbands, 12 ) )
263 : {
264 : Word16 band;
265 1268826 : FOR( band = 0; band < DIRAC_MAX_NBANDS; band++ )
266 : {
267 1171224 : dirac_to_spar_md_bands[band] = band;
268 1171224 : move16();
269 : }
270 97602 : IF( hFbMdft != NULL )
271 : {
272 : Word16 sb, idx1, idx2, b;
273 :
274 96978 : idx1 = -1;
275 96978 : move16();
276 96978 : sb = 0;
277 96978 : move16();
278 4876178 : FOR( b = 0; b < max_band; b++ )
279 : {
280 4779200 : idx2 = hFbMdft->pFb->fb_bin_to_band.p_cldfb_map_to_spar_band[b];
281 4779200 : move16();
282 4779200 : IF( GT_16( idx2, idx1 ) )
283 : {
284 1111762 : band_grouping[sb++] = b;
285 1111762 : move16();
286 1111762 : idx1 = idx2;
287 1111762 : move16();
288 : }
289 : }
290 96978 : band_grouping[sb] = max_band;
291 96978 : move16();
292 :
293 : /* set the remaining bands to max_band to avoid problems for the DirAC parameter estimation with bw < FB */
294 245930 : FOR( b = sb; b <= nbands; b++ )
295 : {
296 148952 : band_grouping[b] = max_band;
297 148952 : move16();
298 : }
299 : }
300 : ELSE
301 : {
302 624 : Copy( DirAC_band_grouping_12, band_grouping, 12 + 1 );
303 : }
304 :
305 97602 : IF( useLowerBandRes )
306 : {
307 9140 : Word16 step = DIRAC_LOW_BANDRES_STEP;
308 9140 : move16();
309 : Word16 reduced_band;
310 27420 : FOR( ( band = enc_param_start_band + 2, reduced_band = enc_param_start_band + 1 ); band <= DIRAC_MAX_NBANDS; ( band += step, reduced_band++ ) )
311 : {
312 18280 : band_grouping[reduced_band] = band_grouping[band];
313 18280 : move16();
314 : }
315 27420 : FOR( ; reduced_band <= DIRAC_MAX_NBANDS; reduced_band++ )
316 : {
317 18280 : band_grouping[reduced_band] = max_band;
318 18280 : move16();
319 : }
320 27420 : FOR( ( band = enc_param_start_band + ( DIRAC_MAX_NBANDS - enc_param_start_band ) / 2 - 1, reduced_band = DIRAC_MAX_NBANDS - 1 ); band >= enc_param_start_band; ( band--, reduced_band -= step ) )
321 : {
322 18280 : dirac_to_spar_md_bands[reduced_band] = dirac_to_spar_md_bands[band];
323 18280 : move16();
324 18280 : dirac_to_spar_md_bands[reduced_band - 1] = dirac_to_spar_md_bands[band];
325 18280 : move16();
326 : }
327 : }
328 : ELSE
329 : {
330 : /* always code the last two fb bands together */
331 88462 : band_grouping[DIRAC_MAX_NBANDS - 1] = max_band;
332 88462 : move16();
333 88462 : dirac_to_spar_md_bands[DIRAC_MAX_NBANDS - 1] = sub( DIRAC_MAX_NBANDS, 2 );
334 88462 : move16();
335 : }
336 : }
337 : ELSE
338 : {
339 0 : assert( 0 && "nbands must be 5 or 6!" );
340 : }
341 : }
342 :
343 : /* Limit the band range to band max */
344 1396143 : FOR( i = 0; i < nbands + 1; i++ )
345 : {
346 1294296 : IF( GT_16( band_grouping[i], max_band ) )
347 : {
348 1003 : band_grouping[i] = max_band;
349 1003 : move16();
350 : }
351 : }
352 :
353 101847 : return;
354 : }
355 : /*-------------------------------------------------------------------*
356 : * ivas_get_dirac_sba_max_md_bits()
357 : *
358 : * Return maximum SBA DirAC metadata bit-budget and nominal bit-budget
359 : *-------------------------------------------------------------------*/
360 :
361 4765 : void ivas_get_dirac_sba_max_md_bits_fx(
362 : const Word32 sba_total_brate,
363 : Word16 *bits_frame_nominal,
364 : Word16 *metadata_max_bits,
365 : Word16 *qmetadata_max_bit_req,
366 : const Word16 nbands,
367 : IVAS_FORMAT ivas_format )
368 : {
369 4765 : IF( LE_32( sba_total_brate, IVAS_13k2 ) )
370 : {
371 435 : *bits_frame_nominal = ACELP_9k60 / FRAMES_PER_SEC;
372 435 : *metadata_max_bits = 70;
373 :
374 435 : move16();
375 435 : move16();
376 : }
377 4330 : ELSE IF( LE_32( sba_total_brate, IVAS_16k4 ) )
378 : {
379 514 : *bits_frame_nominal = ACELP_13k20 / FRAMES_PER_SEC;
380 514 : *metadata_max_bits = 80;
381 :
382 514 : move16();
383 514 : move16();
384 : }
385 3816 : ELSE IF( LE_32( sba_total_brate, IVAS_24k4 ) )
386 : {
387 371 : *bits_frame_nominal = ACELP_16k40 / FRAMES_PER_SEC;
388 371 : *metadata_max_bits = 103;
389 :
390 371 : move16();
391 371 : move16();
392 : /* OSBA needs an additional 2-bits safety margin to avoid acelp crashes */
393 371 : IF( EQ_32( ivas_format, SBA_ISM_FORMAT ) )
394 : {
395 119 : ( *metadata_max_bits ) = sub( ( *metadata_max_bits ), 3 );
396 119 : move16();
397 : }
398 : }
399 3445 : ELSE IF( LE_32( sba_total_brate, IVAS_32k ) )
400 : {
401 394 : *bits_frame_nominal = ACELP_32k / FRAMES_PER_SEC;
402 394 : *metadata_max_bits = 214;
403 :
404 394 : move16();
405 394 : move16();
406 : }
407 3051 : ELSE IF( LE_32( sba_total_brate, IVAS_48k ) )
408 : {
409 219 : *bits_frame_nominal = IVAS_48k / FRAMES_PER_SEC;
410 219 : *metadata_max_bits = 240;
411 :
412 219 : move16();
413 219 : move16();
414 : }
415 2832 : ELSE IF( LE_32( sba_total_brate, IVAS_64k ) )
416 : {
417 334 : *bits_frame_nominal = IVAS_64k / FRAMES_PER_SEC;
418 334 : *metadata_max_bits = 200;
419 :
420 334 : move16();
421 334 : move16();
422 : }
423 2498 : ELSE IF( LE_32( sba_total_brate, IVAS_80k ) )
424 : {
425 402 : *bits_frame_nominal = IVAS_80k / FRAMES_PER_SEC;
426 402 : *metadata_max_bits = 200;
427 :
428 402 : move16();
429 402 : move16();
430 : }
431 2096 : ELSE IF( LE_32( sba_total_brate, IVAS_96k ) )
432 : {
433 353 : *bits_frame_nominal = IVAS_96k / FRAMES_PER_SEC;
434 353 : *metadata_max_bits = 200;
435 :
436 353 : move16();
437 353 : move16();
438 : }
439 1743 : ELSE IF( LE_32( sba_total_brate, IVAS_128k ) )
440 : {
441 290 : *bits_frame_nominal = IVAS_128k / FRAMES_PER_SEC;
442 290 : *metadata_max_bits = 250;
443 :
444 290 : move16();
445 290 : move16();
446 : }
447 : ELSE
448 : {
449 : /* *bits_frame_nominal = (int16_t) ( sba_total_brate / FRAMES_PER_SEC ); */
450 1453 : *bits_frame_nominal = extract_l( Mpy_32_32( sba_total_brate, ONE_BY_FRAMES_PER_SEC_Q31 ) );
451 1453 : move16();
452 1453 : *metadata_max_bits = MAX16B; /* no limit */
453 1453 : move16();
454 : }
455 4765 : Word32 var1 = L_mult0( *metadata_max_bits, nbands );
456 4765 : Word16 exp = 0;
457 4765 : Word16 var2 = BASOP_Util_Divide3232_Scale( var1, 5, &exp );
458 4765 : Word32 var2_32 = L_deposit_h( var2 );
459 4765 : Word32 var4 = var2_32;
460 :
461 4765 : move16();
462 4765 : move32();
463 :
464 4765 : Word16 exp_res = 0;
465 4765 : move16();
466 4765 : IF( var1 % 5 != 0 )
467 : {
468 2099 : var4 = BASOP_Util_Add_Mant32Exp( var2_32, exp, ONE_IN_Q30, 1, &exp_res );
469 2099 : exp = exp_res;
470 2099 : move16();
471 : }
472 4765 : Word16 flag = BASOP_Util_Cmp_Mant32Exp( MAX16B, 31, var4, exp );
473 : Word32 tmp;
474 4765 : IF( EQ_16( flag, 1 ) )
475 : {
476 4281 : tmp = var4;
477 4281 : move32();
478 : }
479 : ELSE
480 : {
481 484 : tmp = MAX16B;
482 484 : exp = 31;
483 :
484 484 : move32();
485 484 : move16();
486 : }
487 4765 : *metadata_max_bits = (Word16) L_shr( tmp, 31 - exp );
488 4765 : *qmetadata_max_bit_req = QMETADATA_MAXBIT_REQ_SBA >> 1;
489 :
490 4765 : move16();
491 4765 : move16();
492 :
493 4765 : return;
494 : }
495 :
496 : /*-------------------------------------------------------------------------
497 : * ivas_dirac_sba_config()
498 : *
499 : * DirAC Configuration function for SBA
500 : *------------------------------------------------------------------------*/
501 4765 : ivas_error ivas_dirac_sba_config_fx(
502 : IVAS_QMETADATA_HANDLE hQMetaData, /* i/o: q_metadata handle */
503 : Word16 *element_mode, /* i/o: element mode of the core coder */
504 : Word32 sba_total_brate, /* i : SBA total bitrate */
505 : const Word16 sba_order, /* i : Ambisonic (SBA) order */
506 : const Word16 nbands /* i : number of frequency bands */
507 : ,
508 : IVAS_FORMAT ivas_format )
509 : {
510 : Word16 nbands_coded;
511 : Word16 hodirac_flag;
512 : ivas_error error;
513 :
514 4765 : Word32 tmp1 = IVAS_192k;
515 4765 : Word32 tmp2 = SPAR_DIRAC_SPLIT_START_BAND;
516 4765 : Word16 exp = 0;
517 :
518 4765 : move32();
519 4765 : move32();
520 4765 : move16();
521 4765 : Word16 tmp3 = BASOP_Util_Divide3232_Scale( tmp1, tmp2, &exp );
522 4765 : Word32 res = L_shr( L_deposit_h( tmp3 ), sub( 31, exp ) );
523 :
524 4765 : error = IVAS_ERR_OK;
525 4765 : hQMetaData->is_masa_ivas_format = 0;
526 4765 : move32();
527 4765 : move16();
528 :
529 4765 : hodirac_flag = ivas_get_hodirac_flag_fx( sba_total_brate, sba_order );
530 :
531 : /* map the bitrate for SID frame */
532 4765 : IF( EQ_32( sba_total_brate, IVAS_SID_5k2 ) )
533 : {
534 0 : IF( EQ_16( *element_mode, IVAS_SCE ) )
535 : {
536 0 : sba_total_brate = ACELP_24k40;
537 0 : move32();
538 : }
539 : ELSE
540 : {
541 0 : sba_total_brate = ACELP_48k;
542 0 : move32();
543 : }
544 : }
545 :
546 4765 : ivas_set_qmetadata_maxbit_req_fx( hQMetaData, SBA_FORMAT );
547 :
548 4765 : IF( LE_32( sba_total_brate, IVAS_16k4 ) )
549 : {
550 949 : hQMetaData->useLowerRes = 1;
551 949 : move16();
552 : }
553 : ELSE
554 : {
555 3816 : hQMetaData->useLowerRes = 0;
556 3816 : move16();
557 : }
558 :
559 4765 : nbands_coded = nbands;
560 4765 : move16();
561 :
562 4765 : IF( LE_32( sba_total_brate, res ) )
563 : {
564 949 : hQMetaData->useLowerBandRes = 1;
565 949 : Word16 tmp = s_and( nbands, 1 );
566 :
567 949 : move16();
568 949 : nbands_coded = add( shr( nbands, 1 ), tmp );
569 : }
570 : ELSE
571 : {
572 3816 : hQMetaData->useLowerBandRes = 0;
573 3816 : move16();
574 3816 : IF( hodirac_flag == 0 )
575 : {
576 3332 : nbands_coded = sub( nbands, 1 ); /* always combine the last two bands */
577 : }
578 : }
579 :
580 : {
581 4765 : Word16 no_dirs = 1;
582 4765 : move16();
583 4765 : IF( hodirac_flag )
584 : {
585 484 : no_dirs = 2;
586 484 : move16();
587 : }
588 :
589 4765 : IF( NE_32( ( error = ivas_qmetadata_allocate_memory_fx( hQMetaData, nbands_coded, no_dirs, 0 ) ), IVAS_ERR_OK ) ) // WIP
590 : {
591 0 : return error;
592 : }
593 : }
594 :
595 4765 : ivas_get_dirac_sba_max_md_bits_fx( sba_total_brate, &hQMetaData->bits_frame_nominal, &hQMetaData->metadata_max_bits, &hQMetaData->qmetadata_max_bit_req, hQMetaData->q_direction[0].cfg.nbands,
596 : ivas_format );
597 :
598 4765 : return error;
599 : }
600 :
601 :
602 685640 : void computeDirectionVectors_fixed(
603 : Word32 *intensity_real_x, /* i: exp = i_e */
604 : Word32 *intensity_real_y, /* i: exp = i_e */
605 : Word32 *intensity_real_z, /* i: exp = i_e */
606 : const Word16 enc_param_start_band,
607 : const Word16 num_frequency_bands,
608 : Word32 *direction_vector_x, /* o: Q30*/
609 : Word32 *direction_vector_y, /* o: Q30*/
610 : Word32 *direction_vector_z, /* o: Q30*/
611 : Word16 i_e /*Exponent of all the intensity buffers*/
612 : ,
613 : Word16 *i_e_band )
614 : {
615 : Word16 i;
616 : Word32 intensityNorm;
617 : Word16 intensityNorm_e;
618 : Word32 temp1;
619 : Word16 exp1;
620 : Word16 norm_x, norm_y, norm_z;
621 : Word32 scaled_x, scaled_y, scaled_z;
622 : Word16 e_x, e_y, e_z;
623 4334564 : FOR( i = enc_param_start_band; i < enc_param_start_band + num_frequency_bands; ++i )
624 : {
625 3648924 : norm_x = norm_l( *intensity_real_x );
626 3648924 : norm_y = norm_l( *intensity_real_y );
627 3648924 : norm_z = norm_l( *intensity_real_z );
628 3648924 : scaled_x = L_shl( *intensity_real_x, norm_x );
629 3648924 : scaled_y = L_shl( *intensity_real_y, norm_y );
630 3648924 : scaled_z = L_shl( *intensity_real_z, norm_z );
631 3648924 : IF( i_e_band != NULL )
632 : {
633 1641828 : e_x = sub( Q31, add( i_e_band[i - enc_param_start_band], norm_x ) );
634 1641828 : e_y = sub( Q31, add( i_e_band[i - enc_param_start_band], norm_y ) );
635 1641828 : e_z = sub( Q31, add( i_e_band[i - enc_param_start_band], norm_z ) );
636 : }
637 : ELSE
638 : {
639 2007096 : e_x = sub( i_e, norm_x );
640 2007096 : e_y = sub( i_e, norm_y );
641 2007096 : e_z = sub( i_e, norm_z );
642 : }
643 3648924 : temp1 = BASOP_Util_Add_Mant32Exp( Mult_32_32( scaled_x, scaled_x ), shl( e_x, 1 ), Mult_32_32( scaled_y, scaled_y ), shl( e_y, 1 ), &exp1 );
644 3648924 : intensityNorm = BASOP_Util_Add_Mant32Exp( temp1, exp1, Mult_32_32( scaled_z, scaled_z ), shl( e_z, 1 ), &intensityNorm_e );
645 :
646 3648924 : IF( LE_32( intensityNorm, EPSILON_FX ) )
647 : {
648 77091 : intensityNorm = L_shl( 1, intensityNorm_e );
649 77091 : *( direction_vector_x++ ) = ONE_IN_Q30;
650 77091 : *( direction_vector_y++ ) = 0;
651 77091 : *( direction_vector_z++ ) = 0;
652 :
653 77091 : move32();
654 77091 : move32();
655 77091 : move32();
656 77091 : intensity_real_x++;
657 77091 : intensity_real_y++;
658 77091 : intensity_real_z++;
659 : }
660 : ELSE
661 : {
662 3571833 : intensityNorm = ISqrt32( intensityNorm, &intensityNorm_e ); /*Q31-intensityNorm_e*/
663 3571833 : *( direction_vector_x++ ) = L_shl( Mult_32_32( scaled_x, intensityNorm ), sub( add( e_x, intensityNorm_e ), 1 ) ); /*Q30*/
664 3571833 : intensity_real_x++;
665 3571833 : *( direction_vector_y++ ) = L_shl( Mult_32_32( scaled_y, intensityNorm ), sub( add( e_y, intensityNorm_e ), 1 ) ); /*Q30*/
666 3571833 : intensity_real_y++;
667 3571833 : *( direction_vector_z++ ) = L_shl( Mult_32_32( scaled_z, intensityNorm ), sub( add( e_z, intensityNorm_e ), 1 ) ); /*Q30*/
668 3571833 : intensity_real_z++;
669 :
670 3571833 : move32();
671 3571833 : move32();
672 3571833 : move32();
673 : }
674 : }
675 :
676 685640 : return;
677 : }
678 : /*-------------------------------------------------------------------------
679 : * computeDirectionVectors()
680 : *
681 : *
682 : *------------------------------------------------------------------------*/
683 :
684 4800 : void computeDirectionVectors_fx(
685 : Word32 *intensity_real_x, // i: Q( i_q )
686 : Word32 *intensity_real_y, // i: Q( i_q )
687 : Word32 *intensity_real_z, // i: Q( i_q )
688 : const Word16 enc_param_start_band,
689 : const Word16 num_frequency_bands,
690 : Word32 *direction_vector_x, // o: Q( i_q )
691 : Word32 *direction_vector_y, // o: Q( i_q )
692 : Word32 *direction_vector_z, // o: Q( i_q )
693 : Word16 *i_q /*input/output Q*/
694 : )
695 : {
696 : Word16 i;
697 : Word32 intensityNorm;
698 :
699 4800 : Word16 sq = sub( 31, sub( shl( *i_q, 1 ), 31 ) );
700 4800 : Word16 sq1 = sub( shl( *i_q, 1 ), 31 );
701 4800 : Word16 exp = sq;
702 4800 : Word16 local_i_q = sq1;
703 4800 : Word16 min_factor = 30;
704 :
705 4800 : move16();
706 4800 : move16();
707 4800 : move16();
708 :
709 4800 : Word32 *init_x = intensity_real_x;
710 4800 : Word32 *init_y = intensity_real_y;
711 4800 : Word32 *init_z = intensity_real_z;
712 : // First loop to determine the Q for the direction vector
713 120000 : FOR( i = enc_param_start_band; i < enc_param_start_band + num_frequency_bands; ++i )
714 : {
715 115200 : intensityNorm = L_add( L_add( Mpy_32_32_r( *( intensity_real_x ), *( intensity_real_x ) ),
716 : Mpy_32_32_r( *( intensity_real_y ), *( intensity_real_y ) ) ),
717 : Mpy_32_32_r( *( intensity_real_z ), *( intensity_real_z ) ) ); /*Q (2*i_q - 31) */
718 115200 : exp = sq;
719 115200 : move16();
720 115200 : IF( LE_32( intensityNorm, EPSILON_FX ) )
721 : {
722 106586 : intensity_real_x++;
723 106586 : intensity_real_y++;
724 106586 : intensity_real_z++;
725 : }
726 : ELSE
727 : {
728 8614 : intensityNorm = ISqrt32( intensityNorm, &exp ); // Q31-exp
729 8614 : intensity_real_x++; // i_q + Q31-exp -31 = i_q -exp
730 8614 : intensity_real_y++; // i_q + Q31-exp -31 = i_q -exp
731 8614 : intensity_real_z++; // i_q + Q31-exp-31 = i_q -exo
732 8614 : local_i_q = sub( *i_q, exp );
733 8614 : min_factor = s_min( min_factor, local_i_q );
734 : }
735 : }
736 4800 : intensity_real_x = init_x;
737 4800 : intensity_real_y = init_y;
738 4800 : intensity_real_z = init_z;
739 : // Actual processing loop for the direction vector
740 120000 : FOR( i = enc_param_start_band; i < enc_param_start_band + num_frequency_bands; ++i )
741 : {
742 115200 : intensityNorm = L_add( L_add( Mpy_32_32_r( *( intensity_real_x ), *( intensity_real_x ) ),
743 : Mpy_32_32_r( *( intensity_real_y ), *( intensity_real_y ) ) ),
744 : Mpy_32_32_r( *( intensity_real_z ), *( intensity_real_z ) ) ); /*Q (2*i_q - 31) */
745 115200 : exp = sq;
746 115200 : move16();
747 115200 : IF( LE_32( intensityNorm, EPSILON_FX ) )
748 : {
749 106586 : intensityNorm = L_shl( 1, min_factor );
750 106586 : *( direction_vector_x++ ) = L_shl( 1, min_factor ); // Q is min_factor
751 106586 : *( direction_vector_y++ ) = 0;
752 106586 : *( direction_vector_z++ ) = 0;
753 106586 : intensity_real_x++;
754 106586 : intensity_real_y++;
755 106586 : intensity_real_z++;
756 :
757 106586 : move32();
758 106586 : move32();
759 106586 : move32();
760 : }
761 : ELSE
762 : {
763 8614 : intensityNorm = ISqrt32( intensityNorm, &exp ); // Q31-exp
764 8614 : Word32 temp = L_shr( Mpy_32_32( *( intensity_real_x++ ), intensityNorm ), ( *i_q - exp - min_factor ) ); // Q is min_factor
765 8614 : *( direction_vector_x++ ) = temp; // i_q + Q31-exp -31 = i_q -exp
766 8614 : temp = L_shr( Mpy_32_32( *( intensity_real_y++ ), intensityNorm ), ( *i_q - exp - min_factor ) ); // Q is min_factor
767 8614 : *( direction_vector_y++ ) = temp; // i_q + Q31-exp -31 = i_q -exp
768 8614 : temp = L_shr( Mpy_32_32( *( intensity_real_z++ ), intensityNorm ), ( *i_q - exp - min_factor ) ); // Q is min_factor
769 8614 : *( direction_vector_z++ ) = temp; // i_q + Q31-exp-31 = i_q -exp
770 :
771 8614 : move32();
772 8614 : move32();
773 8614 : move32();
774 : }
775 : }
776 4800 : *i_q = min_factor;
777 4800 : move16();
778 4800 : return;
779 : }
780 :
781 : /*-------------------------------------------------------------------------
782 : * computeDiffuseness()
783 : *
784 : *
785 : *------------------------------------------------------------------------*/
786 :
787 2400 : void computeDiffuseness_fx(
788 : Word32 *buffer_intensity[DIRAC_NUM_DIMS][DIRAC_NO_COL_AVG_DIFF], // i: Q(q_factor_intensity)
789 : const Word32 *buffer_energy, // i: Q(q_factor_energy)
790 : const Word16 num_freq_bands,
791 : Word32 *diffuseness, // o: exp(out_exp)
792 : Word16 q_factor_intensity,
793 : Word16 q_factor_energy,
794 : Word16 *out_exp /*Ouput Q*/
795 : )
796 : {
797 : Word32 intensity_slow[DIRAC_NUM_DIMS * CLDFB_NO_CHANNELS_MAX];
798 : Word32 intensity_slow_abs[CLDFB_NO_CHANNELS_MAX];
799 : Word32 energy_slow[CLDFB_NO_CHANNELS_MAX];
800 : Word16 i, j, k;
801 2400 : Word32 tmp = 0, tmp_1;
802 2400 : move32();
803 : Word32 *p_tmp;
804 : const Word32 *p_tmp_c;
805 :
806 : /* Compute Intensity slow and energy slow */
807 :
808 2400 : set32_fx( intensity_slow, 0, DIRAC_NUM_DIMS * CLDFB_NO_CHANNELS_MAX );
809 2400 : set32_fx( intensity_slow_abs, 0, CLDFB_NO_CHANNELS_MAX );
810 2400 : set32_fx( energy_slow, 0, CLDFB_NO_CHANNELS_MAX );
811 :
812 79200 : FOR( i = 0; i < DIRAC_NO_COL_AVG_DIFF; ++i )
813 : {
814 : /* Energy slow */
815 76800 : p_tmp_c = buffer_energy + i * num_freq_bands;
816 1920000 : FOR( k = 0; k < num_freq_bands; k++ )
817 : {
818 1843200 : energy_slow[k] = L_add( *( p_tmp_c++ ), energy_slow[k] ); // Q(q_factor_energy)
819 1843200 : move32();
820 : }
821 :
822 : /* Intensity slow */
823 307200 : FOR( j = 0; j < DIRAC_NUM_DIMS; ++j )
824 : {
825 230400 : p_tmp = buffer_intensity[j][i];
826 :
827 5760000 : FOR( k = 0; k < num_freq_bands; k++ )
828 : {
829 5529600 : intensity_slow[j * num_freq_bands + k] = L_add( *( p_tmp++ ), intensity_slow[j * num_freq_bands + k] );
830 5529600 : move32();
831 : }
832 : }
833 : }
834 :
835 : /* intensity_slow.^2 + intensity_slow_abs*/
836 9600 : FOR( j = 0; j < DIRAC_NUM_DIMS; ++j )
837 : {
838 7200 : p_tmp = intensity_slow + j * num_freq_bands;
839 :
840 180000 : FOR( k = 0; k < num_freq_bands; k++ )
841 : {
842 172800 : *( p_tmp ) = Mpy_32_32( *p_tmp, *( p_tmp ) ); // Q( 2*(q_factor_intensity + scale_fact - 1) -31 )
843 172800 : intensity_slow_abs[k] = L_add( *( p_tmp++ ), intensity_slow_abs[k] );
844 172800 : move32();
845 172800 : move32();
846 : }
847 : }
848 2400 : Word16 init_exp = sub( 62, shl( q_factor_intensity, 1 ) ); // 31 - ( 2 * q_factor_intensity - 31 )
849 : Word16 exp;
850 :
851 2400 : Word16 exp1 = 0, exp2;
852 2400 : move16();
853 : /* Compute Diffuseness */
854 2400 : p_tmp = intensity_slow_abs;
855 60000 : FOR( i = 0; i < num_freq_bands; ++i )
856 : {
857 57600 : exp = init_exp;
858 57600 : move16();
859 57600 : Word32 temp = *( p_tmp++ );
860 57600 : move32();
861 57600 : tmp_1 = Sqrt32( temp, &exp );
862 57600 : tmp = L_deposit_h( BASOP_Util_Divide3232_Scale( tmp_1, L_add( energy_slow[i], 1 ), &exp1 ) );
863 57600 : exp2 = add( sub( 31, exp1 ), sub( sub( 31, exp ), q_factor_energy ) );
864 57600 : IF( GT_32( exp2, 30 ) )
865 : {
866 11422 : tmp = L_shr( tmp, sub( exp2, 30 ) );
867 11422 : exp2 = sub( exp2, sub( exp2, 30 ) );
868 : }
869 57600 : tmp = L_sub( L_shl( 1, exp2 ), tmp );
870 : // diffuseness[i] = ( ( tmp < L_shl( 1, exp2 ) ) ? ( ( tmp < 0 ) ? 0 : tmp ) : L_shl( 1, exp2 ) );
871 :
872 57600 : IF( LT_32( tmp, L_shl( 1, exp2 ) ) )
873 : {
874 23278 : IF( tmp < 0 )
875 : {
876 7627 : diffuseness[i] = 0;
877 : }
878 : ELSE
879 : {
880 15651 : diffuseness[i] = tmp;
881 : }
882 : }
883 : ELSE
884 : {
885 34322 : diffuseness[i] = L_shl( 1, exp2 );
886 : }
887 57600 : out_exp[i] = exp2;
888 :
889 57600 : move32();
890 57600 : move16();
891 : }
892 2400 : return;
893 : }
894 :
895 :
896 : /*-------------------------------------------------------------------------
897 : * computeDiffuseness()
898 : *
899 : *
900 : *------------------------------------------------------------------------*/
901 :
902 771940 : void computeDiffuseness_fixed(
903 : Word32 *buffer_intensity[DIRAC_NUM_DIMS][DIRAC_NO_COL_AVG_DIFF], // i: Q(q_factor_intensity)
904 : const Word32 *buffer_energy, // i: Q(q_factor_energy)
905 : const Word16 num_freq_bands,
906 : Word32 *diffuseness, // o: exp(out_exp)
907 : Word16 *q_factor_intensity,
908 : Word16 *q_factor_energy,
909 : Word16 *q_diffuseness /*Ouput Q*/
910 : )
911 : {
912 : Word32 intensity_slow[DIRAC_NUM_DIMS * CLDFB_NO_CHANNELS_MAX];
913 : Word32 intensity_slow_abs[CLDFB_NO_CHANNELS_MAX];
914 : Word32 energy_slow[CLDFB_NO_CHANNELS_MAX];
915 : Word16 i, j, k;
916 771940 : Word32 tmp = 0;
917 771940 : move32();
918 : Word32 *p_tmp;
919 : const Word32 *p_tmp_c;
920 : Word16 min_q_shift1, min_q_shift2, exp1, exp2, q_tmp;
921 : Word16 q_ene, q_intensity, q_intensity_slow;
922 :
923 : /* Compute Intensity slow and energy slow buffer_intensity and buffer_energy */
924 :
925 771940 : set_zero_fx( intensity_slow, i_mult( DIRAC_NUM_DIMS, CLDFB_NO_CHANNELS_MAX ) );
926 771940 : set_zero_fx( intensity_slow_abs, CLDFB_NO_CHANNELS_MAX );
927 771940 : set_zero_fx( energy_slow, CLDFB_NO_CHANNELS_MAX );
928 :
929 : /* Calculate max possible shift for the buffer buffer_energy and buffer_intensity */
930 771940 : min_q_shift1 = Q31;
931 771940 : move16();
932 771940 : min_q_shift1 = s_min( min_q_shift1, getScaleFactor32( buffer_energy, i_mult( DIRAC_NO_COL_AVG_DIFF, num_freq_bands ) ) );
933 771940 : min_q_shift1 = sub( min_q_shift1, find_guarded_bits_fx( DIRAC_NO_COL_AVG_DIFF ) );
934 :
935 771940 : min_q_shift2 = Q31;
936 771940 : move16();
937 3087760 : FOR( i = 0; i < DIRAC_NUM_DIMS; i++ )
938 : {
939 76422060 : FOR( j = 0; j < DIRAC_NO_COL_AVG_DIFF; j++ )
940 : {
941 74106240 : min_q_shift2 = s_min( min_q_shift2, getScaleFactor32( buffer_intensity[i][j], num_freq_bands ) );
942 : }
943 : }
944 771940 : min_q_shift2 = sub( min_q_shift2, find_guarded_bits_fx( DIRAC_NO_COL_AVG_DIFF ) );
945 :
946 771940 : q_ene = add( q_factor_energy[0], min_q_shift1 );
947 771940 : move16();
948 771940 : q_intensity = add( q_factor_intensity[0], min_q_shift2 );
949 771940 : move16();
950 :
951 25474020 : FOR( i = 0; i < DIRAC_NO_COL_AVG_DIFF; ++i )
952 : {
953 : /* Energy slow */
954 24702080 : p_tmp_c = buffer_energy + i * num_freq_bands;
955 :
956 24702080 : q_tmp = add( q_factor_energy[i], min_q_shift1 );
957 :
958 :
959 24702080 : Word16 shift_q = sub( q_tmp, q_ene );
960 24702080 : Word32 shiftEquiv = L_add( 0, 0 );
961 : Word16 shift_qtotal;
962 24702080 : if ( shift_q < 0 )
963 : {
964 878158 : shiftEquiv = L_lshl( (Word32) 0x80000000, shift_q );
965 : }
966 24702080 : if ( shift_q >= 0 )
967 : {
968 23823922 : shiftEquiv = L_add( 0x7FFFFFFF, 0 );
969 : }
970 24702080 : shift_qtotal = sub( min_q_shift1, s_max( shift_q, 0 ) );
971 :
972 328008192 : FOR( k = 0; k < num_freq_bands; k++ )
973 : {
974 303306112 : tmp = L_shl( p_tmp_c[k], shift_qtotal );
975 303306112 : energy_slow[k] = Madd_32_32_r( tmp, energy_slow[k], shiftEquiv );
976 303306112 : move32();
977 : }
978 :
979 :
980 24702080 : q_ene = s_min( q_ene, q_tmp );
981 :
982 : /* Intensity slow */
983 24702080 : q_tmp = add( q_factor_intensity[i], min_q_shift2 );
984 :
985 24702080 : shift_q = sub( q_tmp, q_intensity );
986 24702080 : if ( shift_q < 0 )
987 : {
988 859443 : shiftEquiv = L_lshl( (Word32) 0x80000000, shift_q );
989 : }
990 24702080 : if ( shift_q >= 0 )
991 : {
992 23842637 : shiftEquiv = L_lshl( 0x7FFFFFFF, 0 );
993 : }
994 24702080 : shift_qtotal = sub( min_q_shift2, s_max( shift_q, 0 ) );
995 :
996 98808320 : FOR( j = 0; j < DIRAC_NUM_DIMS; ++j )
997 : {
998 74106240 : p_tmp = buffer_intensity[j][i];
999 984024576 : FOR( k = 0; k < num_freq_bands; k++ )
1000 : {
1001 909918336 : tmp = L_shl( p_tmp[k], shift_qtotal );
1002 909918336 : intensity_slow[j * num_freq_bands + k] = Madd_32_32_r( tmp, intensity_slow[j * num_freq_bands + k], shiftEquiv );
1003 909918336 : move32();
1004 : }
1005 : }
1006 :
1007 24702080 : q_intensity = s_min( q_intensity, q_tmp );
1008 : }
1009 :
1010 771940 : min_q_shift1 = getScaleFactor32( intensity_slow, i_mult( DIRAC_NUM_DIMS, num_freq_bands ) );
1011 771940 : min_q_shift1 = sub( min_q_shift1, idiv1616( add( find_guarded_bits_fx( DIRAC_NUM_DIMS ), 1 ), 2 ) );
1012 771940 : scale_sig32( intensity_slow, i_mult( DIRAC_NUM_DIMS, num_freq_bands ), min_q_shift1 );
1013 771940 : q_intensity = add( q_intensity, min_q_shift1 );
1014 :
1015 : /* intensity_slow.^2 + intensity_slow_abs*/
1016 3087760 : FOR( j = 0; j < DIRAC_NUM_DIMS; ++j )
1017 : {
1018 2315820 : p_tmp = intensity_slow + j * num_freq_bands;
1019 :
1020 30750768 : FOR( k = 0; k < num_freq_bands; k++ )
1021 : {
1022 28434948 : intensity_slow_abs[k] = Madd_32_32( intensity_slow_abs[k], p_tmp[k], p_tmp[k] );
1023 28434948 : move32();
1024 : }
1025 : }
1026 771940 : q_intensity_slow = sub( add( q_intensity, q_intensity ), 31 );
1027 :
1028 : /* Compute Diffuseness */
1029 771940 : p_tmp = intensity_slow_abs;
1030 771940 : exp2 = 0;
1031 771940 : move16();
1032 10250256 : FOR( i = 0; i < num_freq_bands; ++i )
1033 : {
1034 9478316 : exp1 = sub( 31, q_intensity_slow );
1035 9478316 : tmp = Sqrt32( p_tmp[i], &exp1 );
1036 :
1037 9478316 : tmp = BASOP_Util_Divide3232_Scale_newton( tmp, L_add( energy_slow[i], EPSILLON_FX ), &exp2 );
1038 9478316 : q_tmp = add( sub( 31, exp2 ), sub( sub( 31, exp1 ), q_ene ) );
1039 :
1040 9478316 : IF( LT_16( q_tmp, Q30 ) )
1041 : {
1042 303390 : tmp = L_sub( L_shr( ONE_IN_Q30, sub( Q30, q_tmp ) ), tmp );
1043 : }
1044 : ELSE
1045 : {
1046 9174926 : tmp = L_sub( ONE_IN_Q30, L_shr( tmp, sub( q_tmp, Q30 ) ) );
1047 9174926 : q_tmp = Q30;
1048 9174926 : move16();
1049 : }
1050 :
1051 9478316 : IF( GE_32( tmp, L_shl( 1, q_tmp ) ) )
1052 : {
1053 1177928 : diffuseness[i] = ONE_IN_Q30;
1054 1177928 : move32();
1055 : }
1056 8300388 : ELSE IF( tmp <= 0 )
1057 : {
1058 756420 : diffuseness[i] = 0;
1059 756420 : move32();
1060 : }
1061 : ELSE
1062 : {
1063 7543968 : diffuseness[i] = L_shl( tmp, sub( Q30, q_tmp ) );
1064 7543968 : move32();
1065 : }
1066 : }
1067 771940 : *q_diffuseness = Q30;
1068 771940 : move16();
1069 :
1070 771940 : return;
1071 : }
1072 :
1073 :
1074 3761795 : Word32 deindex_azimuth_fx( /* o : output Q22 */
1075 : Word16 id_phi, /* i : index */
1076 : const Word16 no_bits, /* i : number of bits for the spherical grid */
1077 : const Word16 id_th, /* i : elevation index */
1078 : const Word16 remap, /* i : remapping flag */
1079 : const MC_LS_SETUP mc_format /* i : channel format if in MC-mode */
1080 : )
1081 : {
1082 : Word16 flag_delta;
1083 : Word32 dd_fx, delta_phi_fx;
1084 : Word32 phi_hat_fx;
1085 3761795 : test();
1086 3761795 : IF( NE_32( mc_format, MC_LS_SETUP_INVALID ) && EQ_16( no_bits, 2 ) )
1087 : {
1088 9 : IF( s_and( id_phi, 1 ) == 0 )
1089 : {
1090 8 : phi_hat_fx = cb_azi_chan_fx[id_phi / 2]; // Q22
1091 8 : move32();
1092 : }
1093 : ELSE
1094 : {
1095 1 : phi_hat_fx = L_negate( cb_azi_chan_fx[( id_phi + 1 ) / 2] ); // Q22
1096 : }
1097 9 : return phi_hat_fx;
1098 : }
1099 3761786 : flag_delta = extract_l( EQ_16( s_and( id_th, 1 ), 1 ) );
1100 :
1101 3761786 : IF( remap )
1102 : {
1103 265411 : id_phi = add( ivas_qmetadata_dereorder_generic_fx( id_phi ), shr( no_phi_masa[no_bits - 1][id_th], 1 ) );
1104 : }
1105 :
1106 3761786 : delta_phi_fx = Mpy_32_32( 1509949440, no_phi_masa_inv_fx[no_bits - 1][id_th] ); // q = 22
1107 3761786 : test();
1108 3761786 : test();
1109 3761786 : IF( EQ_16( flag_delta, 1 ) && GT_16( no_phi_masa[no_bits - 1][id_th], 2 ) && EQ_32( mc_format, MC_LS_SETUP_INVALID ) )
1110 : {
1111 894498 : dd_fx = Mpy_32_32( delta_phi_fx, 1073741824 ); // q = 22
1112 : }
1113 : ELSE
1114 : {
1115 2867288 : dd_fx = 0;
1116 2867288 : move32();
1117 : }
1118 :
1119 3761786 : id_phi = sub( id_phi, shr( no_phi_masa[no_bits - 1][id_th], 1 ) );
1120 3761786 : phi_hat_fx = L_add( imult3216( delta_phi_fx, id_phi ), dd_fx );
1121 3761786 : IF( NE_32( mc_format, MC_LS_SETUP_INVALID ) )
1122 : {
1123 78589 : Word32 a = L_shr( imult3216( delta_theta_masa_fx[no_bits - 3], id_th ), 22 ); // Q22 -> Q0
1124 78589 : move32();
1125 78589 : Word16 flag = 0;
1126 78589 : move16();
1127 78589 : if ( GT_32( a, MC_MASA_THR_ELEVATION ) )
1128 : {
1129 7212 : flag = 1;
1130 7212 : move16();
1131 : }
1132 78589 : phi_hat_fx = companding_azimuth_fx( phi_hat_fx, mc_format, flag, -1 );
1133 : }
1134 3761786 : return phi_hat_fx;
1135 : }
1136 :
1137 :
1138 : /*----------------------------------------------------------------
1139 : * deindex_spherical_component()
1140 : *
1141 : * decoding the spherical index for one tile
1142 : *-----------------------------------------------------------------*/
1143 :
1144 1905702 : void deindex_spherical_component_fx(
1145 : const UWord16 sph_idx, /* i : spherical index */
1146 : Word32 *az_fx, /* o : decoded azimuth value Q22 */
1147 : Word32 *el_fx, /* o : decoded elevation value Q22 */
1148 : UWord16 *az_idx, /* o : azimuth index */
1149 : UWord16 *el_idx, /* o : elevation index */
1150 : const UWord16 no_bits, /* i : number of bits for the spherical grid */
1151 : const MC_LS_SETUP mc_format /* i : channel format if in MC-mode */
1152 : )
1153 : {
1154 1905702 : assert( sph_idx < ( 1 << no_bits ) );
1155 1905702 : SWITCH( no_bits )
1156 : {
1157 0 : case 0:
1158 0 : *az_fx = 0;
1159 0 : move32();
1160 0 : *el_fx = 0;
1161 0 : move32();
1162 0 : *az_idx = 0;
1163 0 : move16();
1164 0 : *el_idx = 0;
1165 0 : move16();
1166 0 : BREAK;
1167 0 : case 1:
1168 0 : *az_idx = sph_idx;
1169 0 : move16();
1170 0 : *az_fx = L_shl( ( *az_idx ) * ( -180 ), 22 );
1171 0 : *el_fx = 0;
1172 0 : move32();
1173 0 : *el_idx = 0;
1174 0 : move16();
1175 0 : BREAK;
1176 633 : case 2:
1177 633 : *el_fx = 0;
1178 633 : move32();
1179 633 : *el_idx = 0;
1180 633 : move16();
1181 633 : *az_idx = sph_idx;
1182 633 : move16();
1183 633 : *az_fx = deindex_azimuth_fx( *az_idx, no_bits, 0, 0, mc_format );
1184 633 : move16();
1185 633 : BREAK;
1186 1905069 : default:
1187 1905069 : *el_idx = deindex_sph_idx_general_fx( sph_idx, no_bits, el_fx, az_fx, az_idx, mc_format );
1188 1905069 : move16();
1189 1905069 : BREAK;
1190 : }
1191 :
1192 1905702 : return;
1193 : }
1194 :
1195 : /*----------------------------------------------------------------
1196 : * calculate_hodirac_sector_parameters()
1197 : *
1198 : *
1199 : *-----------------------------------------------------------------*/
1200 :
1201 64960 : void calculate_hodirac_sector_parameters_fx(
1202 : DIRAC_ENC_HANDLE hDirAC, /* i : DirAC handle */
1203 : Word32 RealBuffer_fx[DIRAC_MAX_ANA_CHANS][DIRAC_NO_FB_BANDS_MAX], /* i : signal vector (L+1)^2 x N_bins, real part */
1204 : Word32 ImagBuffer_fx[DIRAC_MAX_ANA_CHANS][DIRAC_NO_FB_BANDS_MAX], /* i : signal vector, imaginary part */
1205 : Word16 Qfac, /* i : Q-factor of signal vector */
1206 : const Word32 beta_fx, /* i : forgetting factor for average filtering, Q30 */
1207 : const Word16 *band_grouping, /* i : indices of band groups */
1208 : const Word16 N_bands, /* i : number of bands (groups) */
1209 : const Word16 enc_param_start_band, /* i : first band to process */
1210 : Word32 *azi_fx, /* o : array of sector azimuth angles, flat, Q23 */
1211 : Word32 *ele_fx, /* o : array of sector elevation angles, flat, Q23 */
1212 : Word32 *diff_fx, /* o : array of sector diffuseness values, flat */
1213 : Word16 *diff_exp, /* o : array of sector diffuseness exponents, flat */
1214 : Word32 *ene_fx, /* o : array of sector energy values, flat */
1215 : Word16 *ene_exp /* o : array of sector energy exponents, flat */
1216 : )
1217 : {
1218 : Word16 i_sec, i_bin, i_band;
1219 : Word32 p_real_fx, p_imag_fx, normI_fx, energy_fx, tmp_diff_fx;
1220 : Word16 energy_exp, normI_exp, tmp_diff_exp;
1221 :
1222 : Word32 sec_I_vec_x_fx[NUM_ANA_SECTORS];
1223 : Word32 sec_I_vec_y_fx[NUM_ANA_SECTORS];
1224 : Word32 sec_I_vec_z_fx[NUM_ANA_SECTORS];
1225 : Word16 sec_I_vec_x_exp[NUM_ANA_SECTORS];
1226 : Word16 sec_I_vec_y_exp[NUM_ANA_SECTORS];
1227 : Word16 sec_I_vec_z_exp[NUM_ANA_SECTORS];
1228 :
1229 194880 : FOR( i_sec = 0; i_sec < NUM_ANA_SECTORS; i_sec++ )
1230 : {
1231 129920 : Word32 *p_sec_I_vec_x_fx = &sec_I_vec_x_fx[i_sec];
1232 129920 : Word32 *p_sec_I_vec_y_fx = &sec_I_vec_y_fx[i_sec];
1233 129920 : Word32 *p_sec_I_vec_z_fx = &sec_I_vec_z_fx[i_sec];
1234 129920 : Word16 *p_sec_I_vec_x_exp = &sec_I_vec_x_exp[i_sec];
1235 129920 : Word16 *p_sec_I_vec_y_exp = &sec_I_vec_y_exp[i_sec];
1236 129920 : Word16 *p_sec_I_vec_z_exp = &sec_I_vec_z_exp[i_sec];
1237 :
1238 129920 : const Word32 *p_c_weights_fx = c_weights_fx; // Q30
1239 :
1240 129920 : Word32 *p_ImagBuffer_0_fx = ImagBuffer_fx[0];
1241 129920 : Word32 *p_ImagBuffer_1_fx = ImagBuffer_fx[1];
1242 129920 : Word32 *p_ImagBuffer_2_fx = ImagBuffer_fx[2];
1243 129920 : Word32 *p_ImagBuffer_3_fx = ImagBuffer_fx[3];
1244 129920 : Word32 *p_ImagBuffer_4_fx = ImagBuffer_fx[4];
1245 129920 : Word32 *p_ImagBuffer_5_fx = ImagBuffer_fx[5];
1246 129920 : Word32 *p_ImagBuffer_6_fx = ImagBuffer_fx[6];
1247 129920 : Word32 *p_ImagBuffer_8_fx = ImagBuffer_fx[8];
1248 :
1249 129920 : Word32 *p_RealBuffer_0_fx = RealBuffer_fx[0];
1250 129920 : Word32 *p_RealBuffer_1_fx = RealBuffer_fx[1];
1251 129920 : Word32 *p_RealBuffer_2_fx = RealBuffer_fx[2];
1252 129920 : Word32 *p_RealBuffer_3_fx = RealBuffer_fx[3];
1253 129920 : Word32 *p_RealBuffer_4_fx = RealBuffer_fx[4];
1254 129920 : Word32 *p_RealBuffer_5_fx = RealBuffer_fx[5];
1255 129920 : Word32 *p_RealBuffer_6_fx = RealBuffer_fx[6];
1256 129920 : Word32 *p_RealBuffer_8_fx = RealBuffer_fx[8];
1257 :
1258 1688960 : FOR( i_band = enc_param_start_band; i_band < N_bands; i_band++ )
1259 : {
1260 1559040 : Word32 *p_azi_fx = &azi_fx[i_sec * N_bands + i_band];
1261 1559040 : Word32 *p_ele_fx = &ele_fx[i_sec * N_bands + i_band];
1262 1559040 : Word32 *p_ene_fx = &ene_fx[i_sec * N_bands + i_band];
1263 1559040 : Word16 *p_ene_exp = &ene_exp[i_sec * N_bands + i_band];
1264 :
1265 1559040 : Word32 *p_diff_fx = &diff_fx[i_sec * N_bands + i_band];
1266 1559040 : Word16 *p_diff_exp = &diff_exp[i_sec * N_bands + i_band];
1267 1559040 : Word32 *p_azi_prev_fx = &hDirAC->azi_prev_fx[i_sec * N_bands + i_band];
1268 1559040 : Word32 *p_ele_prev_fx = &hDirAC->ele_prev_fx[i_sec * N_bands + i_band];
1269 :
1270 1559040 : Word32 *p_energy_smth_fx = &hDirAC->energy_smth_fx[i_sec][i_band];
1271 1559040 : Word16 *p_energy_smth_exp = &hDirAC->energy_smth_exp[i_sec][i_band];
1272 1559040 : Word32 *p_sec_I_vec_smth_x_fx = &hDirAC->sec_I_vec_smth_x_fx[i_sec][i_band];
1273 1559040 : Word32 *p_sec_I_vec_smth_y_fx = &hDirAC->sec_I_vec_smth_y_fx[i_sec][i_band];
1274 1559040 : Word32 *p_sec_I_vec_smth_z_fx = &hDirAC->sec_I_vec_smth_z_fx[i_sec][i_band];
1275 1559040 : Word16 *p_sec_I_vec_smth_x_exp = &hDirAC->sec_I_vec_smth_x_exp[i_sec][i_band];
1276 1559040 : Word16 *p_sec_I_vec_smth_y_exp = &hDirAC->sec_I_vec_smth_y_exp[i_sec][i_band];
1277 1559040 : Word16 *p_sec_I_vec_smth_z_exp = &hDirAC->sec_I_vec_smth_z_exp[i_sec][i_band];
1278 1559040 : *p_sec_I_vec_x_fx = 0;
1279 1559040 : move32();
1280 1559040 : *p_sec_I_vec_x_exp = 0;
1281 1559040 : move16();
1282 1559040 : *p_sec_I_vec_y_fx = 0;
1283 1559040 : move32();
1284 1559040 : *p_sec_I_vec_y_exp = 0;
1285 1559040 : move16();
1286 1559040 : *p_sec_I_vec_z_fx = 0;
1287 1559040 : move32();
1288 1559040 : *p_sec_I_vec_z_exp = 0;
1289 1559040 : move16();
1290 1559040 : energy_fx = 0;
1291 1559040 : move32();
1292 1559040 : energy_exp = 0;
1293 1559040 : move16();
1294 :
1295 1559040 : IF( i_sec == 0 )
1296 : {
1297 13769920 : FOR( i_bin = band_grouping[i_band]; i_bin < band_grouping[i_band + 1]; i_bin++ )
1298 : {
1299 12990400 : Word32 w_fx = *( p_c_weights_fx++ ); // Q30
1300 12990400 : move32();
1301 : Word32 sec_w_imag_fx, sec_x_imag_fx, sec_y_imag_fx, sec_z_imag_fx;
1302 : Word32 sec_w_real_fx, sec_x_real_fx, sec_y_real_fx, sec_z_real_fx;
1303 :
1304 12990400 : sec_w_imag_fx = L_add( Mpy_32_32( HODIRAC_FAC1, *( p_ImagBuffer_0_fx ) ), Mpy_32_32( HODIRAC_FAC1, *( p_ImagBuffer_1_fx ) ) ); // Qfac - 2
1305 12990400 : sec_x_imag_fx = L_add( Mpy_32_32( HODIRAC_FAC1, *( p_ImagBuffer_3_fx++ ) ), Mpy_32_32( HODIRAC_FAC2, *( p_ImagBuffer_4_fx++ ) ) ); // Qfac - 2
1306 12990400 : sec_y_imag_fx = L_sub( L_sub( L_add( Mpy_32_32( HODIRAC_FAC3, *( p_ImagBuffer_0_fx++ ) ), Mpy_32_32( HODIRAC_FAC1, *( p_ImagBuffer_1_fx++ ) ) ), Mpy_32_32( HODIRAC_FAC3, *( p_ImagBuffer_6_fx++ ) ) ), Mpy_32_32( HODIRAC_FAC2, *( p_ImagBuffer_8_fx++ ) ) ); // Qfac - 2
1307 12990400 : sec_z_imag_fx = L_add( Mpy_32_32( HODIRAC_FAC1, *( p_ImagBuffer_2_fx++ ) ), Mpy_32_32( HODIRAC_FAC2, *( p_ImagBuffer_5_fx++ ) ) ); // Qfac - 2
1308 :
1309 12990400 : sec_w_real_fx = L_add( Mpy_32_32( HODIRAC_FAC1, *( p_RealBuffer_0_fx ) ), Mpy_32_32( HODIRAC_FAC1, *( p_RealBuffer_1_fx ) ) ); // Qfac - 2
1310 12990400 : sec_x_real_fx = L_add( Mpy_32_32( HODIRAC_FAC1, *( p_RealBuffer_3_fx++ ) ), Mpy_32_32( HODIRAC_FAC2, *( p_RealBuffer_4_fx++ ) ) ); // Qfac - 2
1311 12990400 : sec_y_real_fx = L_sub( L_sub( L_add( Mpy_32_32( HODIRAC_FAC3, *( p_RealBuffer_0_fx++ ) ), Mpy_32_32( HODIRAC_FAC1, *( p_RealBuffer_1_fx++ ) ) ), Mpy_32_32( HODIRAC_FAC3, *( p_RealBuffer_6_fx++ ) ) ), Mpy_32_32( HODIRAC_FAC2, *( p_RealBuffer_8_fx++ ) ) ); // Qfac - 2
1312 12990400 : sec_z_real_fx = L_add( Mpy_32_32( HODIRAC_FAC1, *( p_RealBuffer_2_fx++ ) ), Mpy_32_32( HODIRAC_FAC2, *( p_RealBuffer_5_fx++ ) ) ); // Qfac - 2
1313 :
1314 : Word16 p_q;
1315 : Word32 tmp_x, tmp_y, tmp_z;
1316 : Word16 n, n1, n2;
1317 :
1318 12990400 : p_real_fx = Mpy_32_32( sec_w_real_fx, w_fx ); // ( Qfac - 2 ) + 30 - 31 = Qfac - 3
1319 12990400 : p_imag_fx = Mpy_32_32( sec_w_imag_fx, w_fx ); // ( Qfac - 2 ) + 30 - 31 = Qfac - 3
1320 :
1321 12990400 : n1 = norm_l( p_real_fx );
1322 12990400 : n2 = norm_l( p_imag_fx );
1323 :
1324 12990400 : n = s_min( n1, n2 );
1325 12990400 : p_real_fx = L_shl( p_real_fx, n );
1326 12990400 : p_imag_fx = L_shl( p_imag_fx, n );
1327 :
1328 12990400 : p_q = add( sub( Qfac, 3 ), n );
1329 :
1330 : Word16 tmp_exp, sec_sum_exp;
1331 12990400 : tmp_exp = sub( 66, add( p_q, Qfac ) ); // 31 - ( p_q + Qfac - 35 )
1332 :
1333 12990400 : tmp_x = L_add( L_shr( Mpy_32_32( p_real_fx, sec_x_real_fx ), 2 ), L_shr( Mpy_32_32( p_imag_fx, sec_x_imag_fx ), 2 ) ); // p_q + ( Qfac - 2 ) - 31 - 2 = p_q + Qfac - 35
1334 12990400 : tmp_y = L_add( L_shr( Mpy_32_32( p_real_fx, sec_y_real_fx ), 2 ), L_shr( Mpy_32_32( p_imag_fx, sec_y_imag_fx ), 2 ) ); // p_q + ( Qfac - 2 ) - 31 - 2 = p_q + Qfac - 35
1335 12990400 : tmp_z = L_add( L_shr( Mpy_32_32( p_real_fx, sec_z_real_fx ), 2 ), L_shr( Mpy_32_32( p_imag_fx, sec_z_imag_fx ), 2 ) ); // p_q + ( Qfac - 2 ) - 31 - 2 = p_q + Qfac - 35
1336 :
1337 12990400 : *p_sec_I_vec_x_fx = BASOP_Util_Add_Mant32Exp( *p_sec_I_vec_x_fx, *p_sec_I_vec_x_exp, tmp_x, tmp_exp, p_sec_I_vec_x_exp );
1338 12990400 : move32();
1339 12990400 : *p_sec_I_vec_y_fx = BASOP_Util_Add_Mant32Exp( *p_sec_I_vec_y_fx, *p_sec_I_vec_y_exp, tmp_y, tmp_exp, p_sec_I_vec_y_exp );
1340 12990400 : move32();
1341 12990400 : *p_sec_I_vec_z_fx = BASOP_Util_Add_Mant32Exp( *p_sec_I_vec_z_fx, *p_sec_I_vec_z_exp, tmp_z, tmp_exp, p_sec_I_vec_z_exp );
1342 12990400 : move32();
1343 :
1344 : Word32 tmp1;
1345 : Word64 tmp2, tmp3, tmp4, sec_sum64;
1346 : Word32 tmp5, sec_sum;
1347 12990400 : tmp_exp = sub( 62, add( p_q, p_q ) );
1348 :
1349 12990400 : tmp1 = BASOP_Util_Add_Mant32Exp( Mpy_32_32( p_real_fx, p_real_fx ), tmp_exp, Mpy_32_32( p_imag_fx, p_imag_fx ), tmp_exp, &tmp_exp );
1350 12990400 : tmp2 = W_add( W_mult0_32_32( sec_x_real_fx, sec_x_real_fx ), W_mult0_32_32( sec_x_imag_fx, sec_x_imag_fx ) ); // 2 * (Qfac - 2)
1351 12990400 : tmp3 = W_add( W_mult0_32_32( sec_y_real_fx, sec_y_real_fx ), W_mult0_32_32( sec_y_imag_fx, sec_y_imag_fx ) ); // 2 * (Qfac - 2)
1352 12990400 : tmp4 = W_add( W_mult0_32_32( sec_z_real_fx, sec_z_real_fx ), W_mult0_32_32( sec_z_imag_fx, sec_z_imag_fx ) ); // 2 * (Qfac - 2)
1353 12990400 : sec_sum64 = W_add( W_add( tmp2, tmp3 ), tmp4 ); // 2 * (Qfac - 2)
1354 12990400 : n = W_norm( sec_sum64 );
1355 12990400 : sec_sum64 = W_shl( sec_sum64, n ); // 2 * (Qfac - 2) + n
1356 12990400 : sec_sum = W_extract_h( sec_sum64 ); // 2 * (Qfac - 2) + n - 32 = 2 * Qfac + n - 36
1357 12990400 : sec_sum_exp = sub( 67, add( shl( Qfac, 1 ), n ) );
1358 :
1359 : // divide by 2:
1360 12990400 : tmp1 = L_shr( tmp1, 1 );
1361 12990400 : sec_sum = L_shr( sec_sum, 1 );
1362 :
1363 12990400 : tmp5 = BASOP_Util_Add_Mant32Exp( tmp1, tmp_exp, sec_sum, sec_sum_exp, &tmp_exp );
1364 12990400 : energy_fx = BASOP_Util_Add_Mant32Exp( energy_fx, energy_exp, tmp5, tmp_exp, &energy_exp );
1365 : }
1366 : }
1367 : ELSE
1368 : {
1369 13769920 : FOR( i_bin = band_grouping[i_band]; i_bin < band_grouping[i_band + 1]; i_bin++ )
1370 : {
1371 12990400 : Word32 w_fx = *( p_c_weights_fx++ ); // Q30
1372 12990400 : move32();
1373 : Word32 sec_w_imag_fx, sec_x_imag_fx, sec_y_imag_fx, sec_z_imag_fx;
1374 : Word32 sec_w_real_fx, sec_x_real_fx, sec_y_real_fx, sec_z_real_fx;
1375 :
1376 12990400 : sec_w_imag_fx = L_sub( Mpy_32_32( HODIRAC_FAC1, *( p_ImagBuffer_0_fx ) ), Mpy_32_32( HODIRAC_FAC1, *( p_ImagBuffer_1_fx ) ) ); // Qfac - 2
1377 12990400 : sec_x_imag_fx = L_sub( Mpy_32_32( HODIRAC_FAC1, *( p_ImagBuffer_3_fx++ ) ), Mpy_32_32( HODIRAC_FAC2, *( p_ImagBuffer_4_fx++ ) ) ); // Qfac - 2
1378 12990400 : sec_y_imag_fx = L_add( L_add( L_add( Mpy_32_32( -HODIRAC_FAC3, *( p_ImagBuffer_0_fx++ ) ), Mpy_32_32( HODIRAC_FAC1, *( p_ImagBuffer_1_fx++ ) ) ), Mpy_32_32( HODIRAC_FAC3, *( p_ImagBuffer_6_fx++ ) ) ), Mpy_32_32( HODIRAC_FAC2, *( p_ImagBuffer_8_fx++ ) ) ); // Qfac - 2
1379 12990400 : sec_z_imag_fx = L_sub( Mpy_32_32( HODIRAC_FAC1, *( p_ImagBuffer_2_fx++ ) ), Mpy_32_32( HODIRAC_FAC2, *( p_ImagBuffer_5_fx++ ) ) ); // Qfac - 2
1380 :
1381 12990400 : sec_w_real_fx = L_sub( Mpy_32_32( HODIRAC_FAC1, *( p_RealBuffer_0_fx ) ), Mpy_32_32( HODIRAC_FAC1, *( p_RealBuffer_1_fx ) ) ); // Qfac - 2
1382 12990400 : sec_x_real_fx = L_sub( Mpy_32_32( HODIRAC_FAC1, *( p_RealBuffer_3_fx++ ) ), Mpy_32_32( HODIRAC_FAC2, *( p_RealBuffer_4_fx++ ) ) ); // Qfac - 2
1383 12990400 : sec_y_real_fx = L_add( L_add( L_add( Mpy_32_32( -HODIRAC_FAC3, *( p_RealBuffer_0_fx++ ) ), Mpy_32_32( HODIRAC_FAC1, *( p_RealBuffer_1_fx++ ) ) ), Mpy_32_32( HODIRAC_FAC3, *( p_RealBuffer_6_fx++ ) ) ), Mpy_32_32( HODIRAC_FAC2, *( p_RealBuffer_8_fx++ ) ) ); // Qfac - 2
1384 12990400 : sec_z_real_fx = L_sub( Mpy_32_32( HODIRAC_FAC1, *( p_RealBuffer_2_fx++ ) ), Mpy_32_32( HODIRAC_FAC2, *( p_RealBuffer_5_fx++ ) ) ); // Qfac - 2
1385 :
1386 : Word16 p_q;
1387 :
1388 12990400 : p_real_fx = Mpy_32_32( sec_w_real_fx, w_fx ); // ( Qfac - 2 ) + 30 - 31 = Qfac - 3
1389 12990400 : p_imag_fx = Mpy_32_32( sec_w_imag_fx, w_fx ); // ( Qfac - 2 ) + 30 - 31 = Qfac - 3
1390 :
1391 : Word32 tmp_x, tmp_y, tmp_z;
1392 : Word16 n, n1, n2;
1393 :
1394 12990400 : n1 = norm_l( p_real_fx );
1395 12990400 : n2 = norm_l( p_imag_fx );
1396 :
1397 12990400 : n = s_min( n1, n2 );
1398 :
1399 12990400 : p_real_fx = L_shl( p_real_fx, n );
1400 12990400 : p_imag_fx = L_shl( p_imag_fx, n );
1401 :
1402 12990400 : p_q = add( sub( Qfac, 3 ), n );
1403 :
1404 : Word16 tmp_exp, sec_sum_exp;
1405 12990400 : tmp_exp = sub( 66, add( p_q, Qfac ) ); // 31 - ( p_q + Qfac - 35 )
1406 :
1407 12990400 : tmp_x = L_add( L_shr( Mpy_32_32( p_real_fx, sec_x_real_fx ), 2 ), L_shr( Mpy_32_32( p_imag_fx, sec_x_imag_fx ), 2 ) ); // p_q + ( Qfac - 2 ) - 31 - 2 = p_q + Qfac - 35
1408 12990400 : tmp_y = L_add( L_shr( Mpy_32_32( p_real_fx, sec_y_real_fx ), 2 ), L_shr( Mpy_32_32( p_imag_fx, sec_y_imag_fx ), 2 ) ); // p_q + ( Qfac - 2 ) - 31 - 2 = p_q + Qfac - 35
1409 12990400 : tmp_z = L_add( L_shr( Mpy_32_32( p_real_fx, sec_z_real_fx ), 2 ), L_shr( Mpy_32_32( p_imag_fx, sec_z_imag_fx ), 2 ) ); // p_q + ( Qfac - 2 ) - 31 - 2 = p_q + Qfac - 35
1410 12990400 : *p_sec_I_vec_x_fx = BASOP_Util_Add_Mant32Exp( *p_sec_I_vec_x_fx, *p_sec_I_vec_x_exp, tmp_x, tmp_exp, p_sec_I_vec_x_exp );
1411 12990400 : move32();
1412 12990400 : *p_sec_I_vec_y_fx = BASOP_Util_Add_Mant32Exp( *p_sec_I_vec_y_fx, *p_sec_I_vec_y_exp, tmp_y, tmp_exp, p_sec_I_vec_y_exp );
1413 12990400 : move32();
1414 12990400 : *p_sec_I_vec_z_fx = BASOP_Util_Add_Mant32Exp( *p_sec_I_vec_z_fx, *p_sec_I_vec_z_exp, tmp_z, tmp_exp, p_sec_I_vec_z_exp );
1415 12990400 : move32();
1416 :
1417 : Word32 tmp1;
1418 : Word64 tmp2, tmp3, tmp4, sec_sum64;
1419 : Word32 tmp5, sec_sum;
1420 12990400 : tmp_exp = sub( 62, add( p_q, p_q ) );
1421 :
1422 12990400 : tmp1 = BASOP_Util_Add_Mant32Exp( Mpy_32_32( p_real_fx, p_real_fx ), tmp_exp, Mpy_32_32( p_imag_fx, p_imag_fx ), tmp_exp, &tmp_exp );
1423 12990400 : tmp2 = W_add( W_mult0_32_32( sec_x_real_fx, sec_x_real_fx ), W_mult0_32_32( sec_x_imag_fx, sec_x_imag_fx ) ); // 2 * (Qfac - 2)
1424 12990400 : tmp3 = W_add( W_mult0_32_32( sec_y_real_fx, sec_y_real_fx ), W_mult0_32_32( sec_y_imag_fx, sec_y_imag_fx ) ); // 2 * (Qfac - 2)
1425 12990400 : tmp4 = W_add( W_mult0_32_32( sec_z_real_fx, sec_z_real_fx ), W_mult0_32_32( sec_z_imag_fx, sec_z_imag_fx ) ); // 2 * (Qfac - 2)
1426 12990400 : sec_sum64 = W_add( W_add( tmp2, tmp3 ), tmp4 ); // 2 * (Qfac - 2)
1427 12990400 : n = W_norm( sec_sum64 );
1428 12990400 : sec_sum64 = W_shl( sec_sum64, n ); // 2 * (Qfac - 2) + n
1429 12990400 : sec_sum = W_extract_h( sec_sum64 ); // 2 * (Qfac - 2) + n - 32 = 2 * Qfac + n - 36
1430 12990400 : sec_sum_exp = sub( 67, add( shl( Qfac, 1 ), n ) );
1431 :
1432 : // divide by 2:
1433 12990400 : tmp1 = L_shr( tmp1, 1 );
1434 12990400 : sec_sum = L_shr( sec_sum, 1 );
1435 :
1436 12990400 : tmp5 = BASOP_Util_Add_Mant32Exp( tmp1, tmp_exp, sec_sum, sec_sum_exp, &tmp_exp );
1437 12990400 : energy_fx = BASOP_Util_Add_Mant32Exp( energy_fx, energy_exp, tmp5, tmp_exp, &energy_exp );
1438 : }
1439 : }
1440 :
1441 1559040 : IF( hDirAC->firstrun_sector_params )
1442 : {
1443 672 : *p_sec_I_vec_smth_x_fx = *p_sec_I_vec_x_fx;
1444 672 : move32();
1445 672 : *p_sec_I_vec_smth_y_fx = *p_sec_I_vec_y_fx;
1446 672 : move32();
1447 672 : *p_sec_I_vec_smth_z_fx = *p_sec_I_vec_z_fx;
1448 672 : move32();
1449 672 : *p_energy_smth_fx = energy_fx;
1450 672 : move32();
1451 672 : *p_sec_I_vec_smth_x_exp = *p_sec_I_vec_x_exp;
1452 672 : move16();
1453 672 : *p_sec_I_vec_smth_y_exp = *p_sec_I_vec_y_exp;
1454 672 : move16();
1455 672 : *p_sec_I_vec_smth_z_exp = *p_sec_I_vec_z_exp;
1456 672 : move16();
1457 672 : *p_energy_smth_exp = energy_exp;
1458 672 : move16();
1459 : }
1460 : ELSE
1461 : {
1462 1558368 : Word32 w_fx = L_sub( ONE_IN_Q30, beta_fx ); // Q30
1463 :
1464 1558368 : *p_sec_I_vec_smth_x_fx = BASOP_Util_Add_Mant32Exp( Mpy_32_32( w_fx, *p_sec_I_vec_x_fx ), add( *p_sec_I_vec_x_exp, 1 ), Mpy_32_32( beta_fx, *p_sec_I_vec_smth_x_fx ), add( *p_sec_I_vec_smth_x_exp, 1 ), p_sec_I_vec_smth_x_exp );
1465 1558368 : move32();
1466 1558368 : *p_sec_I_vec_smth_y_fx = BASOP_Util_Add_Mant32Exp( Mpy_32_32( w_fx, *p_sec_I_vec_y_fx ), add( *p_sec_I_vec_y_exp, 1 ), Mpy_32_32( beta_fx, *p_sec_I_vec_smth_y_fx ), add( *p_sec_I_vec_smth_y_exp, 1 ), p_sec_I_vec_smth_y_exp );
1467 1558368 : move32();
1468 1558368 : *p_sec_I_vec_smth_z_fx = BASOP_Util_Add_Mant32Exp( Mpy_32_32( w_fx, *p_sec_I_vec_z_fx ), add( *p_sec_I_vec_z_exp, 1 ), Mpy_32_32( beta_fx, *p_sec_I_vec_smth_z_fx ), add( *p_sec_I_vec_smth_z_exp, 1 ), p_sec_I_vec_smth_z_exp );
1469 1558368 : move32();
1470 1558368 : *p_energy_smth_fx = BASOP_Util_Add_Mant32Exp( Mpy_32_32( w_fx, energy_fx ), add( energy_exp, 1 ), Mpy_32_32( beta_fx, *p_energy_smth_fx ), add( *p_energy_smth_exp, 1 ), p_energy_smth_exp );
1471 : }
1472 :
1473 1559040 : IF( LT_32( energy_fx, EPSILON_FX_SMALL ) )
1474 : {
1475 137920 : *p_azi_fx = 0;
1476 137920 : move32();
1477 137920 : *p_ele_fx = 0;
1478 137920 : move32();
1479 137920 : *p_ene_fx = 0;
1480 137920 : move32();
1481 137920 : *p_ene_exp = 0;
1482 137920 : move16();
1483 137920 : *p_diff_fx = ONE_IN_Q30;
1484 137920 : move32();
1485 137920 : *p_diff_exp = 1;
1486 137920 : move16();
1487 : }
1488 : ELSE
1489 : {
1490 : Word32 tmp_x, tmp_y, tmp_z, tmp_xy_hypo, tmp32;
1491 : Word16 tmp16, tmp_e;
1492 1421120 : tmp_x = Mpy_32_32( *p_sec_I_vec_smth_x_fx, *p_sec_I_vec_smth_x_fx );
1493 1421120 : tmp_y = Mpy_32_32( *p_sec_I_vec_smth_y_fx, *p_sec_I_vec_smth_y_fx );
1494 1421120 : tmp_z = Mpy_32_32( *p_sec_I_vec_smth_z_fx, *p_sec_I_vec_smth_z_fx );
1495 1421120 : tmp32 = BASOP_Util_Add_Mant32Exp( tmp_x, shl( *p_sec_I_vec_smth_x_exp, 1 ), tmp_y, shl( *p_sec_I_vec_smth_y_exp, 1 ), &tmp_e );
1496 1421120 : normI_fx = BASOP_Util_Add_Mant32Exp( tmp32, tmp_e, tmp_z, shl( *p_sec_I_vec_smth_z_exp, 1 ), &normI_exp );
1497 1421120 : normI_fx = Sqrt32( normI_fx, &normI_exp );
1498 :
1499 1421120 : tmp32 = BASOP_Util_Add_Mant32Exp( tmp32, tmp_e, 0, 0, &tmp_e ); // normalising value of tmp32
1500 1421120 : tmp_xy_hypo = Sqrt32( tmp32, &tmp_e ); // sqrt(x^2 + y^2)
1501 :
1502 1421120 : tmp16 = BASOP_util_atan2( *p_sec_I_vec_smth_y_fx, *p_sec_I_vec_smth_x_fx, sub( *p_sec_I_vec_smth_y_exp, *p_sec_I_vec_smth_x_exp ) ); // Q13
1503 1421120 : *p_azi_fx = Mpy_32_32( L_deposit_h( tmp16 ), _180_OVER_PI_Q25 ); // (Q13 + 16) + Q25 - 31 = 54 - 31 = Q23
1504 1421120 : move32();
1505 1421120 : tmp16 = BASOP_util_atan2( *p_sec_I_vec_smth_z_fx, L_add( tmp_xy_hypo, EPSILON_FX_SMALL ), sub( *p_sec_I_vec_smth_z_exp, tmp_e ) ); // Q13
1506 1421120 : *p_ele_fx = Mpy_32_32( L_deposit_h( tmp16 ), _180_OVER_PI_Q25 ); // (Q13 + 16) + Q25 - 31 = 54 - 31 = Q23
1507 1421120 : move32();
1508 1421120 : *p_ene_fx = *p_energy_smth_fx;
1509 1421120 : move32();
1510 1421120 : *p_ene_exp = *p_energy_smth_exp;
1511 1421120 : move16();
1512 :
1513 1421120 : tmp32 = L_deposit_h( BASOP_Util_Divide3232_Scale( normI_fx, L_add( *p_energy_smth_fx, EPSILON_FX_SMALL ), &tmp_e ) );
1514 1421120 : tmp_e = add( tmp_e, sub( normI_exp, *p_energy_smth_exp ) );
1515 1421120 : tmp32 = BASOP_Util_Add_Mant32Exp( ONE_IN_Q30, 1, L_negate( tmp32 ), tmp_e, &tmp_e );
1516 1421120 : *p_diff_fx = tmp32;
1517 1421120 : move32();
1518 1421120 : *p_diff_exp = tmp_e;
1519 1421120 : move16();
1520 : }
1521 :
1522 1559040 : tmp_diff_fx = *p_diff_fx;
1523 1559040 : move32();
1524 1559040 : tmp_diff_exp = *p_diff_exp;
1525 1559040 : move16();
1526 1559040 : if ( tmp_diff_fx < 0 )
1527 : {
1528 0 : tmp_diff_fx = 0;
1529 0 : move32();
1530 : }
1531 :
1532 1559040 : tmp_diff_fx = L_shr( tmp_diff_fx, sub( 2, tmp_diff_exp ) ); // Q29
1533 1559040 : tmp_diff_exp = 2;
1534 1559040 : move16();
1535 :
1536 1559040 : IF( GT_32( tmp_diff_fx, ONE_IN_Q28 ) )
1537 : {
1538 619787 : IF( hDirAC->firstrun_sector_params )
1539 : {
1540 203 : *p_azi_fx = 0;
1541 203 : move32();
1542 203 : *p_ele_fx = 0;
1543 203 : move32();
1544 : }
1545 : ELSE
1546 : {
1547 619584 : *p_azi_fx = L_shl( L_add( Mpy_32_32( L_sub( ONE_IN_Q29, tmp_diff_fx ), *p_azi_fx ), Mpy_32_32( L_sub( tmp_diff_fx, ONE_IN_Q29 / 2 ), *p_azi_prev_fx ) ), 1 ); // Q29 + Q23 - 31 = Q21
1548 619584 : move32();
1549 619584 : *p_ele_fx = L_shl( L_add( Mpy_32_32( L_sub( ONE_IN_Q29, tmp_diff_fx ), *p_ele_fx ), Mpy_32_32( L_sub( tmp_diff_fx, ONE_IN_Q29 / 2 ), *p_ele_prev_fx ) ), 1 ); // Q29 + Q23 - 31 = Q21
1550 619584 : move32();
1551 619584 : *p_azi_fx = L_shl( *p_azi_fx, 2 ); // Q21 -> Q23;
1552 619584 : move32();
1553 619584 : *p_ele_fx = L_shl( *p_ele_fx, 2 ); // Q21 -> Q23;
1554 619584 : move32();
1555 : }
1556 : }
1557 : ELSE
1558 : {
1559 939253 : *p_azi_prev_fx = *p_azi_fx;
1560 939253 : move32();
1561 939253 : *p_ele_prev_fx = *p_ele_fx;
1562 939253 : move32();
1563 : }
1564 : }
1565 : }
1566 :
1567 64960 : hDirAC->firstrun_sector_params = 0;
1568 64960 : move16();
1569 :
1570 64960 : return;
1571 : }
1572 :
1573 :
1574 : /*-----------------------------------------------------------------------*
1575 : * Local functions
1576 : *-----------------------------------------------------------------------*/
1577 :
1578 :
1579 : /*-------------------------------------------------------------------*
1580 : * deindex_sph_idx_general()
1581 : *
1582 : * deindex the spherical index for more than 2 bits for the spherical grid
1583 : *----------------------------------------------------------------------*/
1584 :
1585 1905069 : static UWord16 deindex_sph_idx_general_fx(
1586 : const Word16 idx_sph, /* i : spherical index */
1587 : const Word16 no_bits, /* i : number of bits in the spherical grid */
1588 : Word32 *theta_dec_fx, /* o : decoded elevation value Q22 */
1589 : Word32 *phi_dec_fx, /* o : decoded azimuth value Q22 */
1590 : UWord16 *p_id_phi, /* o : decoded azimuth index */
1591 : const MC_LS_SETUP mc_format /* i : channel format if in MC-mode */
1592 : )
1593 : {
1594 : Word16 i;
1595 : UWord16 id_th;
1596 : Word16 q_id_th;
1597 : Word32 id_th_fx;
1598 : Word16 sign_theta;
1599 : Word16 id_phi;
1600 : Word16 cum_n[250];
1601 : Word16 no_th;
1602 : const Word16 *n;
1603 :
1604 1905069 : id_th = 0;
1605 1905069 : move16();
1606 1905069 : id_phi = 0;
1607 1905069 : move16();
1608 1905069 : sign_theta = 1;
1609 1905069 : move16();
1610 :
1611 1905069 : no_th = no_theta_masa[no_bits - 3];
1612 1905069 : move16();
1613 1905069 : n = no_phi_masa[no_bits - 1];
1614 1905069 : IF( NE_32( mc_format, MC_LS_SETUP_INVALID ) )
1615 : {
1616 : /* indexing */
1617 :
1618 8828 : cum_n[0] = n[0];
1619 8828 : move16();
1620 8828 : IF( GE_16( idx_sph, cum_n[0] ) )
1621 : {
1622 10904 : FOR( i = 1; i < no_th; i++ )
1623 : {
1624 10904 : cum_n[i] = add( cum_n[i - 1], n[i] );
1625 10904 : move16();
1626 10904 : IF( LT_16( idx_sph, cum_n[i] ) )
1627 : {
1628 7481 : id_th = i;
1629 7481 : move16();
1630 7481 : id_phi = sub( idx_sph, cum_n[i - 1] );
1631 7481 : BREAK;
1632 : }
1633 : }
1634 : }
1635 : }
1636 : ELSE
1637 : {
1638 : /* Starting from Equator, alternating positive and negative */
1639 1896241 : cum_n[0] = n[0];
1640 1896241 : move16();
1641 1896241 : IF( GE_16( idx_sph, cum_n[0] ) )
1642 : {
1643 1407604 : FOR( i = 1; i < no_th; i++ )
1644 : {
1645 1407604 : cum_n[2 * i - 1] = add( cum_n[2 * i - 2], n[i] );
1646 1407604 : move16();
1647 :
1648 1407604 : IF( LT_16( idx_sph, cum_n[2 * i - 1] ) )
1649 : {
1650 404180 : id_th = i;
1651 404180 : move16();
1652 404180 : sign_theta = 1;
1653 404180 : move16();
1654 404180 : id_phi = sub( idx_sph, cum_n[2 * i - 2] );
1655 404180 : BREAK;
1656 : }
1657 :
1658 1003424 : cum_n[2 * i] = add( cum_n[2 * i - 1], n[i] );
1659 1003424 : move16();
1660 :
1661 1003424 : IF( LT_16( idx_sph, cum_n[2 * i] ) )
1662 : {
1663 438489 : id_th = i;
1664 438489 : move16();
1665 438489 : sign_theta = -1;
1666 438489 : move16();
1667 438489 : id_phi = sub( idx_sph, cum_n[2 * i - 1] );
1668 438489 : BREAK;
1669 : }
1670 :
1671 564935 : IF( EQ_16( i, sub( no_th, 1 ) ) )
1672 : {
1673 0 : id_th = i;
1674 0 : move16();
1675 0 : sign_theta = -1;
1676 0 : move16();
1677 0 : id_phi = 0; /* idx_sph - cum_n[2*i-1]; */
1678 0 : move16();
1679 0 : BREAK;
1680 : }
1681 : }
1682 : }
1683 : }
1684 :
1685 1905069 : IF( id_th == 0 )
1686 : {
1687 1054919 : id_phi = idx_sph;
1688 1054919 : move16();
1689 : }
1690 : ELSE
1691 : {
1692 850150 : test();
1693 850150 : if ( EQ_32( id_th, sub( no_th, 1 ) ) && GT_16( no_bits, 4 ) )
1694 : {
1695 2468 : id_phi = 0;
1696 2468 : move16();
1697 : }
1698 : }
1699 :
1700 1905069 : q_id_th = norm_l( id_th );
1701 1905069 : id_th_fx = L_shl( id_th, q_id_th );
1702 1905069 : *theta_dec_fx = L_shl( Mpy_32_32( id_th_fx, delta_theta_masa_fx[no_bits - 3] ), sub( 31, q_id_th ) ); // Q22
1703 1905069 : move32();
1704 :
1705 1905069 : IF( GE_32( *theta_dec_fx, 90 << Q22 ) )
1706 : {
1707 2438 : *theta_dec_fx = ( 90 << 22 ) * sign_theta;
1708 2438 : move32();
1709 2438 : *phi_dec_fx = 0;
1710 2438 : move32();
1711 2438 : *p_id_phi = 0;
1712 2438 : move16();
1713 : }
1714 : ELSE
1715 : {
1716 1902631 : *theta_dec_fx *= sign_theta;
1717 :
1718 1902631 : *phi_dec_fx = deindex_azimuth_fx( id_phi, no_bits, id_th, 0, mc_format ); // Q22
1719 1902631 : move32();
1720 1902631 : *p_id_phi = id_phi;
1721 1902631 : move16();
1722 : }
1723 :
1724 1905069 : return id_th;
1725 : }
|
