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 842081 : 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 842081 : test();
65 842081 : IF( GT_16( sba_order, 1 ) && GT_32( ivas_total_brate, IVAS_256k ) )
66 : {
67 127231 : return 1;
68 : }
69 : ELSE
70 : {
71 714850 : return 0;
72 : }
73 : }
74 : /*-------------------------------------------------------------------------
75 : * ivas_dirac_sba_config()
76 : *
77 : * DirAC Configuration function; used also in MASA decoder
78 : *------------------------------------------------------------------------*/
79 4243 : 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 4243 : error = IVAS_ERR_OK;
98 4243 : move32();
99 :
100 4243 : IF( enc_dec == ENC )
101 : {
102 0 : ivas_format = ( (Encoder_Struct *) st_ivas )->hEncoderConfig->ivas_format;
103 0 : move32();
104 0 : element_mode = &( (Encoder_Struct *) st_ivas )->hEncoderConfig->element_mode_init;
105 0 : sba_order = ( (Encoder_Struct *) st_ivas )->sba_analysis_order;
106 0 : move16();
107 0 : ivas_total_brate = ( (Encoder_Struct *) st_ivas )->hEncoderConfig->ivas_total_brate;
108 0 : move32();
109 0 : Fs = ( (Encoder_Struct *) st_ivas )->hEncoderConfig->input_Fs;
110 0 : move32();
111 0 : band_grouping = ( (Encoder_Struct *) st_ivas )->hDirAC->band_grouping;
112 0 : hConfig = ( (Encoder_Struct *) st_ivas )->hDirAC->hConfig;
113 0 : hQMetaData = ( (Encoder_Struct *) st_ivas )->hQMetaData;
114 0 : IF( ( (Encoder_Struct *) st_ivas )->hSpar != NULL )
115 : {
116 0 : hFbMdft = ( (Encoder_Struct *) st_ivas )->hSpar->hFbMixer;
117 0 : 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 4243 : test();
152 4243 : IF( EQ_32( ivas_format, SBA_FORMAT ) || EQ_32( ivas_format, SBA_ISM_FORMAT ) )
153 : {
154 1140 : hConfig->nbands = IVAS_MAX_NUM_BANDS;
155 1140 : move16();
156 :
157 1140 : spar_dirac_split_band = s_min( IVAS_MAX_NUM_BANDS, SPAR_DIRAC_SPLIT_START_BAND );
158 :
159 1140 : IF( ivas_get_hodirac_flag_fx( ivas_total_brate, sba_order ) ) // add call after merge of 100861_dirac_dec
160 : {
161 126 : spar_dirac_split_band = 0;
162 126 : 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 4243 : hConfig->enc_param_start_band = 0;
174 4243 : hConfig->dec_param_estim = FALSE;
175 :
176 4243 : move16();
177 4243 : move16();
178 :
179 4243 : test();
180 4243 : IF( EQ_32( ivas_format, SBA_FORMAT ) || EQ_32( ivas_format, SBA_ISM_FORMAT ) ) /* skip for MASA decoder */
181 : {
182 1140 : 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 1140 : IF( hQMetaData != NULL )
190 : {
191 1140 : if ( enc_dec == ENC )
192 : {
193 0 : hConfig->nbands = hQMetaData->q_direction[0].cfg.nbands;
194 0 : move16();
195 : }
196 1140 : hConfig->enc_param_start_band = add( hQMetaData->q_direction[0].cfg.start_band, spar_dirac_split_band );
197 1140 : move16();
198 : }
199 :
200 1140 : hConfig->dec_param_estim = TRUE;
201 1140 : move16();
202 1140 : if ( EQ_16( hConfig->dec_param_estim, TRUE ) )
203 : {
204 1140 : hConfig->enc_param_start_band = spar_dirac_split_band;
205 1140 : move16();
206 : }
207 :
208 1140 : IF( ivas_get_hodirac_flag_fx( ivas_total_brate, sba_order ) )
209 : {
210 126 : hConfig->dec_param_estim = FALSE;
211 126 : hConfig->enc_param_start_band = 0;
212 :
213 126 : move16();
214 126 : move16();
215 :
216 126 : set8_fx( (Word8 *) hQMetaData->twoDirBands, (Word8) 1, hQMetaData->q_direction[0].cfg.nbands );
217 126 : hQMetaData->numTwoDirBands = (UWord8) hQMetaData->q_direction[0].cfg.nbands;
218 126 : move16();
219 : }
220 : }
221 :
222 4243 : test();
223 4243 : IF( EQ_32( ivas_format, SBA_FORMAT ) || EQ_32( ivas_format, SBA_ISM_FORMAT ) )
224 : {
225 : // 100861_dirac_dec
226 1140 : 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 4243 : 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 99986 : 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 99986 : IF( EQ_16( nbands, 5 ) )
255 : {
256 4245 : Copy( DirAC_band_grouping_5, band_grouping, 5 + 1 );
257 : }
258 95741 : ELSE IF( EQ_16( nbands, 6 ) )
259 : {
260 0 : Copy( DirAC_band_grouping_6, band_grouping, 6 + 1 );
261 : }
262 95741 : ELSE IF( EQ_16( nbands, 12 ) )
263 : {
264 : Word16 band;
265 1244633 : FOR( band = 0; band < DIRAC_MAX_NBANDS; band++ )
266 : {
267 1148892 : dirac_to_spar_md_bands[band] = band;
268 1148892 : move16();
269 : }
270 95741 : IF( hFbMdft != NULL )
271 : {
272 : Word16 sb, idx1, idx2, b;
273 :
274 95117 : idx1 = -1;
275 95117 : move16();
276 95117 : sb = 0;
277 95117 : move16();
278 4774817 : FOR( b = 0; b < max_band; b++ )
279 : {
280 4679700 : idx2 = hFbMdft->pFb->fb_bin_to_band.p_cldfb_map_to_spar_band[b];
281 4679700 : move16();
282 4679700 : IF( GT_16( idx2, idx1 ) )
283 : {
284 1090038 : band_grouping[sb++] = b;
285 1090038 : move16();
286 1090038 : idx1 = idx2;
287 1090038 : move16();
288 : }
289 : }
290 95117 : band_grouping[sb] = max_band;
291 95117 : move16();
292 :
293 : /* set the remaining bands to max_band to avoid problems for the DirAC parameter estimation with bw < FB */
294 241600 : FOR( b = sb; b <= nbands; b++ )
295 : {
296 146483 : band_grouping[b] = max_band;
297 146483 : move16();
298 : }
299 : }
300 : ELSE
301 : {
302 624 : Copy( DirAC_band_grouping_12, band_grouping, 12 + 1 );
303 : }
304 :
305 95741 : IF( useLowerBandRes )
306 : {
307 8766 : Word16 step = DIRAC_LOW_BANDRES_STEP;
308 8766 : move16();
309 : Word16 reduced_band;
310 26298 : FOR( ( band = enc_param_start_band + 2, reduced_band = enc_param_start_band + 1 ); band <= DIRAC_MAX_NBANDS; ( band += step, reduced_band++ ) )
311 : {
312 17532 : band_grouping[reduced_band] = band_grouping[band];
313 17532 : move16();
314 : }
315 26298 : FOR( ; reduced_band <= DIRAC_MAX_NBANDS; reduced_band++ )
316 : {
317 17532 : band_grouping[reduced_band] = max_band;
318 17532 : move16();
319 : }
320 26298 : 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 17532 : dirac_to_spar_md_bands[reduced_band] = dirac_to_spar_md_bands[band];
323 17532 : move16();
324 17532 : dirac_to_spar_md_bands[reduced_band - 1] = dirac_to_spar_md_bands[band];
325 17532 : move16();
326 : }
327 : }
328 : ELSE
329 : {
330 : /* always code the last two fb bands together */
331 86975 : band_grouping[DIRAC_MAX_NBANDS - 1] = max_band;
332 86975 : move16();
333 86975 : dirac_to_spar_md_bands[DIRAC_MAX_NBANDS - 1] = sub( DIRAC_MAX_NBANDS, 2 );
334 86975 : 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 1370089 : FOR( i = 0; i < nbands + 1; i++ )
345 : {
346 1270103 : IF( GT_16( band_grouping[i], max_band ) )
347 : {
348 1003 : band_grouping[i] = max_band;
349 1003 : move16();
350 : }
351 : }
352 :
353 99986 : 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 2904 : 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 2904 : IF( LE_32( sba_total_brate, IVAS_13k2 ) )
370 : {
371 265 : *bits_frame_nominal = ACELP_9k60 / FRAMES_PER_SEC;
372 265 : *metadata_max_bits = 70;
373 :
374 265 : move16();
375 265 : move16();
376 : }
377 2639 : ELSE IF( LE_32( sba_total_brate, IVAS_16k4 ) )
378 : {
379 310 : *bits_frame_nominal = ACELP_13k20 / FRAMES_PER_SEC;
380 310 : *metadata_max_bits = 80;
381 :
382 310 : move16();
383 310 : move16();
384 : }
385 2329 : ELSE IF( LE_32( sba_total_brate, IVAS_24k4 ) )
386 : {
387 230 : *bits_frame_nominal = ACELP_16k40 / FRAMES_PER_SEC;
388 230 : *metadata_max_bits = 103;
389 :
390 230 : move16();
391 230 : move16();
392 : /* OSBA needs an additional 2-bits safety margin to avoid acelp crashes */
393 230 : IF( EQ_32( ivas_format, SBA_ISM_FORMAT ) )
394 : {
395 72 : ( *metadata_max_bits ) = sub( ( *metadata_max_bits ), 3 );
396 72 : move16();
397 : }
398 : }
399 2099 : ELSE IF( LE_32( sba_total_brate, IVAS_32k ) )
400 : {
401 232 : *bits_frame_nominal = ACELP_32k / FRAMES_PER_SEC;
402 232 : *metadata_max_bits = 214;
403 :
404 232 : move16();
405 232 : move16();
406 : }
407 1867 : ELSE IF( LE_32( sba_total_brate, IVAS_48k ) )
408 : {
409 138 : *bits_frame_nominal = IVAS_48k / FRAMES_PER_SEC;
410 138 : *metadata_max_bits = 240;
411 :
412 138 : move16();
413 138 : move16();
414 : }
415 1729 : ELSE IF( LE_32( sba_total_brate, IVAS_64k ) )
416 : {
417 200 : *bits_frame_nominal = IVAS_64k / FRAMES_PER_SEC;
418 200 : *metadata_max_bits = 200;
419 :
420 200 : move16();
421 200 : move16();
422 : }
423 1529 : ELSE IF( LE_32( sba_total_brate, IVAS_80k ) )
424 : {
425 249 : *bits_frame_nominal = IVAS_80k / FRAMES_PER_SEC;
426 249 : *metadata_max_bits = 200;
427 :
428 249 : move16();
429 249 : move16();
430 : }
431 1280 : ELSE IF( LE_32( sba_total_brate, IVAS_96k ) )
432 : {
433 215 : *bits_frame_nominal = IVAS_96k / FRAMES_PER_SEC;
434 215 : *metadata_max_bits = 200;
435 :
436 215 : move16();
437 215 : move16();
438 : }
439 1065 : ELSE IF( LE_32( sba_total_brate, IVAS_128k ) )
440 : {
441 180 : *bits_frame_nominal = IVAS_128k / FRAMES_PER_SEC;
442 180 : *metadata_max_bits = 250;
443 :
444 180 : move16();
445 180 : move16();
446 : }
447 : ELSE
448 : {
449 : /* *bits_frame_nominal = (int16_t) ( sba_total_brate / FRAMES_PER_SEC ); */
450 885 : *bits_frame_nominal = extract_l( Mpy_32_32( sba_total_brate, ONE_BY_FRAMES_PER_SEC_Q31 ) );
451 885 : move16();
452 885 : *metadata_max_bits = MAX16B; /* no limit */
453 885 : move16();
454 : }
455 2904 : Word32 var1 = L_mult0( *metadata_max_bits, nbands );
456 2904 : Word16 exp = 0;
457 2904 : Word16 var2 = BASOP_Util_Divide3232_Scale( var1, 5, &exp );
458 2904 : Word32 var2_32 = L_deposit_h( var2 );
459 2904 : Word32 var4 = var2_32;
460 :
461 2904 : move16();
462 2904 : move32();
463 :
464 2904 : Word16 exp_res = 0;
465 2904 : move16();
466 2904 : IF( var1 % 5 != 0 )
467 : {
468 1275 : var4 = BASOP_Util_Add_Mant32Exp( var2_32, exp, ONE_IN_Q30, 1, &exp_res );
469 1275 : exp = exp_res;
470 1275 : move16();
471 : }
472 2904 : Word16 flag = BASOP_Util_Cmp_Mant32Exp( MAX16B, 31, var4, exp );
473 : Word32 tmp;
474 2904 : IF( EQ_16( flag, 1 ) )
475 : {
476 2606 : tmp = var4;
477 2606 : move32();
478 : }
479 : ELSE
480 : {
481 298 : tmp = MAX16B;
482 298 : exp = 31;
483 :
484 298 : move32();
485 298 : move16();
486 : }
487 2904 : *metadata_max_bits = (Word16) L_shr( tmp, 31 - exp );
488 2904 : *qmetadata_max_bit_req = QMETADATA_MAXBIT_REQ_SBA >> 1;
489 :
490 2904 : move16();
491 2904 : move16();
492 :
493 2904 : return;
494 : }
495 :
496 : /*-------------------------------------------------------------------------
497 : * ivas_dirac_sba_config()
498 : *
499 : * DirAC Configuration function for SBA
500 : *------------------------------------------------------------------------*/
501 2904 : 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 2904 : Word32 tmp1 = IVAS_192k;
515 2904 : Word32 tmp2 = SPAR_DIRAC_SPLIT_START_BAND;
516 2904 : Word16 exp = 0;
517 :
518 2904 : move32();
519 2904 : move32();
520 2904 : move16();
521 2904 : Word16 tmp3 = BASOP_Util_Divide3232_Scale( tmp1, tmp2, &exp );
522 2904 : Word32 res = L_shr( L_deposit_h( tmp3 ), sub( 31, exp ) );
523 :
524 2904 : error = IVAS_ERR_OK;
525 2904 : hQMetaData->is_masa_ivas_format = 0;
526 2904 : move32();
527 2904 : move16();
528 :
529 2904 : hodirac_flag = ivas_get_hodirac_flag_fx( sba_total_brate, sba_order );
530 :
531 : /* map the bitrate for SID frame */
532 2904 : 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 2904 : ivas_set_qmetadata_maxbit_req_fx( hQMetaData, SBA_FORMAT );
547 :
548 2904 : IF( LE_32( sba_total_brate, IVAS_16k4 ) )
549 : {
550 575 : hQMetaData->useLowerRes = 1;
551 575 : move16();
552 : }
553 : ELSE
554 : {
555 2329 : hQMetaData->useLowerRes = 0;
556 2329 : move16();
557 : }
558 :
559 2904 : nbands_coded = nbands;
560 2904 : move16();
561 :
562 2904 : IF( LE_32( sba_total_brate, res ) )
563 : {
564 575 : hQMetaData->useLowerBandRes = 1;
565 575 : Word16 tmp = s_and( nbands, 1 );
566 :
567 575 : move16();
568 575 : nbands_coded = add( shr( nbands, 1 ), tmp );
569 : }
570 : ELSE
571 : {
572 2329 : hQMetaData->useLowerBandRes = 0;
573 2329 : move16();
574 2329 : IF( hodirac_flag == 0 )
575 : {
576 2031 : nbands_coded = sub( nbands, 1 ); /* always combine the last two bands */
577 : }
578 : }
579 :
580 : {
581 2904 : Word16 no_dirs = 1;
582 2904 : move16();
583 2904 : IF( hodirac_flag )
584 : {
585 298 : no_dirs = 2;
586 298 : move16();
587 : }
588 :
589 2904 : 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 2904 : 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 2904 : return error;
599 : }
600 :
601 :
602 2400 : 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 60000 : FOR( i = enc_param_start_band; i < enc_param_start_band + num_frequency_bands; ++i )
624 : {
625 57600 : norm_x = norm_l( *intensity_real_x );
626 57600 : norm_y = norm_l( *intensity_real_y );
627 57600 : norm_z = norm_l( *intensity_real_z );
628 57600 : scaled_x = L_shl( *intensity_real_x, norm_x );
629 57600 : scaled_y = L_shl( *intensity_real_y, norm_y );
630 57600 : scaled_z = L_shl( *intensity_real_z, norm_z );
631 57600 : IF( i_e_band != NULL )
632 : {
633 0 : e_x = sub( Q31, add( i_e_band[i - enc_param_start_band], norm_x ) );
634 0 : e_y = sub( Q31, add( i_e_band[i - enc_param_start_band], norm_y ) );
635 0 : e_z = sub( Q31, add( i_e_band[i - enc_param_start_band], norm_z ) );
636 : }
637 : ELSE
638 : {
639 57600 : e_x = sub( i_e, norm_x );
640 57600 : e_y = sub( i_e, norm_y );
641 57600 : e_z = sub( i_e, norm_z );
642 : }
643 57600 : 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 57600 : intensityNorm = BASOP_Util_Add_Mant32Exp( temp1, exp1, Mult_32_32( scaled_z, scaled_z ), shl( e_z, 1 ), &intensityNorm_e );
645 :
646 57600 : IF( LE_32( intensityNorm, EPSILON_FX ) )
647 : {
648 1 : intensityNorm = L_shl( 1, intensityNorm_e );
649 1 : *( direction_vector_x++ ) = ONE_IN_Q30;
650 1 : *( direction_vector_y++ ) = 0;
651 1 : *( direction_vector_z++ ) = 0;
652 :
653 1 : move32();
654 1 : move32();
655 1 : move32();
656 1 : intensity_real_x++;
657 1 : intensity_real_y++;
658 1 : intensity_real_z++;
659 : }
660 : ELSE
661 : {
662 57599 : intensityNorm = ISqrt32( intensityNorm, &intensityNorm_e ); /*Q31-intensityNorm_e*/
663 57599 : *( direction_vector_x++ ) = L_shl( Mult_32_32( scaled_x, intensityNorm ), sub( add( e_x, intensityNorm_e ), 1 ) ); /*Q30*/
664 57599 : intensity_real_x++;
665 57599 : *( direction_vector_y++ ) = L_shl( Mult_32_32( scaled_y, intensityNorm ), sub( add( e_y, intensityNorm_e ), 1 ) ); /*Q30*/
666 57599 : intensity_real_y++;
667 57599 : *( direction_vector_z++ ) = L_shl( Mult_32_32( scaled_z, intensityNorm ), sub( add( e_z, intensityNorm_e ), 1 ) ); /*Q30*/
668 57599 : intensity_real_z++;
669 :
670 57599 : move32();
671 57599 : move32();
672 57599 : move32();
673 : }
674 : }
675 :
676 2400 : 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 699620 : 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 699620 : Word32 tmp = 0;
917 699620 : 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 699620 : set_zero_fx( intensity_slow, i_mult( DIRAC_NUM_DIMS, CLDFB_NO_CHANNELS_MAX ) );
926 699620 : set_zero_fx( intensity_slow_abs, CLDFB_NO_CHANNELS_MAX );
927 699620 : set_zero_fx( energy_slow, CLDFB_NO_CHANNELS_MAX );
928 :
929 : /* Calculate max possible shift for the buffer buffer_energy and buffer_intensity */
930 699620 : min_q_shift1 = Q31;
931 699620 : move16();
932 699620 : min_q_shift1 = s_min( min_q_shift1, getScaleFactor32( buffer_energy, i_mult( DIRAC_NO_COL_AVG_DIFF, num_freq_bands ) ) );
933 699620 : min_q_shift1 = sub( min_q_shift1, find_guarded_bits_fx( DIRAC_NO_COL_AVG_DIFF ) );
934 :
935 699620 : min_q_shift2 = Q31;
936 699620 : move16();
937 2798480 : FOR( i = 0; i < DIRAC_NUM_DIMS; i++ )
938 : {
939 69262380 : FOR( j = 0; j < DIRAC_NO_COL_AVG_DIFF; j++ )
940 : {
941 67163520 : min_q_shift2 = s_min( min_q_shift2, getScaleFactor32( buffer_intensity[i][j], num_freq_bands ) );
942 : }
943 : }
944 699620 : min_q_shift2 = sub( min_q_shift2, find_guarded_bits_fx( DIRAC_NO_COL_AVG_DIFF ) );
945 :
946 699620 : q_ene = add( q_factor_energy[0], min_q_shift1 );
947 699620 : move16();
948 699620 : q_intensity = add( q_factor_intensity[0], min_q_shift2 );
949 699620 : move16();
950 :
951 23087460 : FOR( i = 0; i < DIRAC_NO_COL_AVG_DIFF; ++i )
952 : {
953 : /* Energy slow */
954 22387840 : p_tmp_c = buffer_energy + i * num_freq_bands;
955 :
956 22387840 : q_tmp = add( q_factor_energy[i], min_q_shift1 );
957 :
958 :
959 22387840 : Word16 shift_q = sub( q_tmp, q_ene );
960 22387840 : Word32 shiftEquiv = L_add( 0, 0 );
961 : Word16 shift_qtotal;
962 22387840 : if ( shift_q < 0 )
963 : {
964 722434 : shiftEquiv = L_lshl( (Word32) 0x80000000, shift_q );
965 : }
966 22387840 : if ( shift_q >= 0 )
967 : {
968 21665406 : shiftEquiv = L_add( 0x7FFFFFFF, 0 );
969 : }
970 22387840 : shift_qtotal = sub( min_q_shift1, s_max( shift_q, 0 ) );
971 :
972 270650880 : FOR( k = 0; k < num_freq_bands; k++ )
973 : {
974 248263040 : tmp = L_shl( p_tmp_c[k], shift_qtotal );
975 248263040 : energy_slow[k] = Madd_32_32_r( tmp, energy_slow[k], shiftEquiv );
976 248263040 : move32();
977 : }
978 :
979 :
980 22387840 : q_ene = s_min( q_ene, q_tmp );
981 :
982 : /* Intensity slow */
983 22387840 : q_tmp = add( q_factor_intensity[i], min_q_shift2 );
984 :
985 22387840 : shift_q = sub( q_tmp, q_intensity );
986 22387840 : if ( shift_q < 0 )
987 : {
988 718142 : shiftEquiv = L_lshl( (Word32) 0x80000000, shift_q );
989 : }
990 22387840 : if ( shift_q >= 0 )
991 : {
992 21669698 : shiftEquiv = L_lshl( 0x7FFFFFFF, 0 );
993 : }
994 22387840 : shift_qtotal = sub( min_q_shift2, s_max( shift_q, 0 ) );
995 :
996 89551360 : FOR( j = 0; j < DIRAC_NUM_DIMS; ++j )
997 : {
998 67163520 : p_tmp = buffer_intensity[j][i];
999 811952640 : FOR( k = 0; k < num_freq_bands; k++ )
1000 : {
1001 744789120 : tmp = L_shl( p_tmp[k], shift_qtotal );
1002 744789120 : intensity_slow[j * num_freq_bands + k] = Madd_32_32_r( tmp, intensity_slow[j * num_freq_bands + k], shiftEquiv );
1003 744789120 : move32();
1004 : }
1005 : }
1006 :
1007 22387840 : q_intensity = s_min( q_intensity, q_tmp );
1008 : }
1009 :
1010 699620 : min_q_shift1 = getScaleFactor32( intensity_slow, i_mult( DIRAC_NUM_DIMS, num_freq_bands ) );
1011 699620 : min_q_shift1 = sub( min_q_shift1, idiv1616( add( find_guarded_bits_fx( DIRAC_NUM_DIMS ), 1 ), 2 ) );
1012 699620 : scale_sig32( intensity_slow, i_mult( DIRAC_NUM_DIMS, num_freq_bands ), min_q_shift1 );
1013 699620 : q_intensity = add( q_intensity, min_q_shift1 );
1014 :
1015 : /* intensity_slow.^2 + intensity_slow_abs*/
1016 2798480 : FOR( j = 0; j < DIRAC_NUM_DIMS; ++j )
1017 : {
1018 2098860 : p_tmp = intensity_slow + j * num_freq_bands;
1019 :
1020 25373520 : FOR( k = 0; k < num_freq_bands; k++ )
1021 : {
1022 23274660 : intensity_slow_abs[k] = Madd_32_32( intensity_slow_abs[k], p_tmp[k], p_tmp[k] );
1023 23274660 : move32();
1024 : }
1025 : }
1026 699620 : q_intensity_slow = sub( add( q_intensity, q_intensity ), 31 );
1027 :
1028 : /* Compute Diffuseness */
1029 699620 : p_tmp = intensity_slow_abs;
1030 699620 : exp2 = 0;
1031 699620 : move16();
1032 8457840 : FOR( i = 0; i < num_freq_bands; ++i )
1033 : {
1034 7758220 : exp1 = sub( 31, q_intensity_slow );
1035 7758220 : tmp = Sqrt32( p_tmp[i], &exp1 );
1036 :
1037 7758220 : tmp = BASOP_Util_Divide3232_Scale_newton( tmp, L_add( energy_slow[i], EPSILLON_FX ), &exp2 );
1038 7758220 : q_tmp = add( sub( 31, exp2 ), sub( sub( 31, exp1 ), q_ene ) );
1039 :
1040 7758220 : IF( LT_16( q_tmp, Q30 ) )
1041 : {
1042 150610 : tmp = L_sub( L_shr( ONE_IN_Q30, sub( Q30, q_tmp ) ), tmp );
1043 : }
1044 : ELSE
1045 : {
1046 7607610 : tmp = L_sub( ONE_IN_Q30, L_shr( tmp, sub( q_tmp, Q30 ) ) );
1047 7607610 : q_tmp = Q30;
1048 7607610 : move16();
1049 : }
1050 :
1051 7758220 : IF( GE_32( tmp, L_shl( 1, q_tmp ) ) )
1052 : {
1053 842471 : diffuseness[i] = ONE_IN_Q30;
1054 842471 : move32();
1055 : }
1056 6915749 : ELSE IF( tmp <= 0 )
1057 : {
1058 493497 : diffuseness[i] = 0;
1059 493497 : move32();
1060 : }
1061 : ELSE
1062 : {
1063 6422252 : diffuseness[i] = L_shl( tmp, sub( Q30, q_tmp ) );
1064 6422252 : move32();
1065 : }
1066 : }
1067 699620 : *q_diffuseness = Q30;
1068 699620 : move16();
1069 :
1070 699620 : 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 0 : 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 0 : FOR( i_sec = 0; i_sec < NUM_ANA_SECTORS; i_sec++ )
1230 : {
1231 0 : Word32 *p_sec_I_vec_x_fx = &sec_I_vec_x_fx[i_sec];
1232 0 : Word32 *p_sec_I_vec_y_fx = &sec_I_vec_y_fx[i_sec];
1233 0 : Word32 *p_sec_I_vec_z_fx = &sec_I_vec_z_fx[i_sec];
1234 0 : Word16 *p_sec_I_vec_x_exp = &sec_I_vec_x_exp[i_sec];
1235 0 : Word16 *p_sec_I_vec_y_exp = &sec_I_vec_y_exp[i_sec];
1236 0 : Word16 *p_sec_I_vec_z_exp = &sec_I_vec_z_exp[i_sec];
1237 :
1238 0 : const Word32 *p_c_weights_fx = c_weights_fx; // Q30
1239 :
1240 0 : Word32 *p_ImagBuffer_0_fx = ImagBuffer_fx[0];
1241 0 : Word32 *p_ImagBuffer_1_fx = ImagBuffer_fx[1];
1242 0 : Word32 *p_ImagBuffer_2_fx = ImagBuffer_fx[2];
1243 0 : Word32 *p_ImagBuffer_3_fx = ImagBuffer_fx[3];
1244 0 : Word32 *p_ImagBuffer_4_fx = ImagBuffer_fx[4];
1245 0 : Word32 *p_ImagBuffer_5_fx = ImagBuffer_fx[5];
1246 0 : Word32 *p_ImagBuffer_6_fx = ImagBuffer_fx[6];
1247 0 : Word32 *p_ImagBuffer_8_fx = ImagBuffer_fx[8];
1248 :
1249 0 : Word32 *p_RealBuffer_0_fx = RealBuffer_fx[0];
1250 0 : Word32 *p_RealBuffer_1_fx = RealBuffer_fx[1];
1251 0 : Word32 *p_RealBuffer_2_fx = RealBuffer_fx[2];
1252 0 : Word32 *p_RealBuffer_3_fx = RealBuffer_fx[3];
1253 0 : Word32 *p_RealBuffer_4_fx = RealBuffer_fx[4];
1254 0 : Word32 *p_RealBuffer_5_fx = RealBuffer_fx[5];
1255 0 : Word32 *p_RealBuffer_6_fx = RealBuffer_fx[6];
1256 0 : Word32 *p_RealBuffer_8_fx = RealBuffer_fx[8];
1257 :
1258 0 : FOR( i_band = enc_param_start_band; i_band < N_bands; i_band++ )
1259 : {
1260 0 : Word32 *p_azi_fx = &azi_fx[i_sec * N_bands + i_band];
1261 0 : Word32 *p_ele_fx = &ele_fx[i_sec * N_bands + i_band];
1262 0 : Word32 *p_ene_fx = &ene_fx[i_sec * N_bands + i_band];
1263 0 : Word16 *p_ene_exp = &ene_exp[i_sec * N_bands + i_band];
1264 :
1265 0 : Word32 *p_diff_fx = &diff_fx[i_sec * N_bands + i_band];
1266 0 : Word16 *p_diff_exp = &diff_exp[i_sec * N_bands + i_band];
1267 0 : Word32 *p_azi_prev_fx = &hDirAC->azi_prev_fx[i_sec * N_bands + i_band];
1268 0 : Word32 *p_ele_prev_fx = &hDirAC->ele_prev_fx[i_sec * N_bands + i_band];
1269 :
1270 0 : Word32 *p_energy_smth_fx = &hDirAC->energy_smth_fx[i_sec][i_band];
1271 0 : Word16 *p_energy_smth_exp = &hDirAC->energy_smth_exp[i_sec][i_band];
1272 0 : Word32 *p_sec_I_vec_smth_x_fx = &hDirAC->sec_I_vec_smth_x_fx[i_sec][i_band];
1273 0 : Word32 *p_sec_I_vec_smth_y_fx = &hDirAC->sec_I_vec_smth_y_fx[i_sec][i_band];
1274 0 : Word32 *p_sec_I_vec_smth_z_fx = &hDirAC->sec_I_vec_smth_z_fx[i_sec][i_band];
1275 0 : Word16 *p_sec_I_vec_smth_x_exp = &hDirAC->sec_I_vec_smth_x_exp[i_sec][i_band];
1276 0 : Word16 *p_sec_I_vec_smth_y_exp = &hDirAC->sec_I_vec_smth_y_exp[i_sec][i_band];
1277 0 : Word16 *p_sec_I_vec_smth_z_exp = &hDirAC->sec_I_vec_smth_z_exp[i_sec][i_band];
1278 0 : *p_sec_I_vec_x_fx = 0;
1279 0 : move32();
1280 0 : *p_sec_I_vec_x_exp = 0;
1281 0 : move16();
1282 0 : *p_sec_I_vec_y_fx = 0;
1283 0 : move32();
1284 0 : *p_sec_I_vec_y_exp = 0;
1285 0 : move16();
1286 0 : *p_sec_I_vec_z_fx = 0;
1287 0 : move32();
1288 0 : *p_sec_I_vec_z_exp = 0;
1289 0 : move16();
1290 0 : energy_fx = 0;
1291 0 : move32();
1292 0 : energy_exp = 0;
1293 0 : move16();
1294 :
1295 0 : IF( i_sec == 0 )
1296 : {
1297 0 : FOR( i_bin = band_grouping[i_band]; i_bin < band_grouping[i_band + 1]; i_bin++ )
1298 : {
1299 0 : Word32 w_fx = *( p_c_weights_fx++ ); // Q30
1300 0 : 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 0 : 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 0 : 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 0 : 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 0 : 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 0 : 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 0 : 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 0 : 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 0 : 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 0 : p_real_fx = Mpy_32_32( sec_w_real_fx, w_fx ); // ( Qfac - 2 ) + 30 - 31 = Qfac - 3
1319 0 : p_imag_fx = Mpy_32_32( sec_w_imag_fx, w_fx ); // ( Qfac - 2 ) + 30 - 31 = Qfac - 3
1320 :
1321 0 : n1 = norm_l( p_real_fx );
1322 0 : n2 = norm_l( p_imag_fx );
1323 :
1324 0 : n = s_min( n1, n2 );
1325 0 : p_real_fx = L_shl( p_real_fx, n );
1326 0 : p_imag_fx = L_shl( p_imag_fx, n );
1327 :
1328 0 : p_q = add( sub( Qfac, 3 ), n );
1329 :
1330 : Word16 tmp_exp, sec_sum_exp;
1331 0 : tmp_exp = sub( 66, add( p_q, Qfac ) ); // 31 - ( p_q + Qfac - 35 )
1332 :
1333 0 : 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 0 : 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 0 : 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 0 : *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 0 : move32();
1339 0 : *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 0 : move32();
1341 0 : *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 0 : move32();
1343 :
1344 : Word32 tmp1;
1345 : Word64 tmp2, tmp3, tmp4, sec_sum64;
1346 : Word32 tmp5, sec_sum;
1347 0 : tmp_exp = sub( 62, add( p_q, p_q ) );
1348 :
1349 0 : 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 0 : 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 0 : 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 0 : 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 0 : sec_sum64 = W_add( W_add( tmp2, tmp3 ), tmp4 ); // 2 * (Qfac - 2)
1354 0 : n = W_norm( sec_sum64 );
1355 0 : sec_sum64 = W_shl( sec_sum64, n ); // 2 * (Qfac - 2) + n
1356 0 : sec_sum = W_extract_h( sec_sum64 ); // 2 * (Qfac - 2) + n - 32 = 2 * Qfac + n - 36
1357 0 : sec_sum_exp = sub( 67, add( shl( Qfac, 1 ), n ) );
1358 :
1359 : // divide by 2:
1360 0 : tmp1 = L_shr( tmp1, 1 );
1361 0 : sec_sum = L_shr( sec_sum, 1 );
1362 :
1363 0 : tmp5 = BASOP_Util_Add_Mant32Exp( tmp1, tmp_exp, sec_sum, sec_sum_exp, &tmp_exp );
1364 0 : energy_fx = BASOP_Util_Add_Mant32Exp( energy_fx, energy_exp, tmp5, tmp_exp, &energy_exp );
1365 : }
1366 : }
1367 : ELSE
1368 : {
1369 0 : FOR( i_bin = band_grouping[i_band]; i_bin < band_grouping[i_band + 1]; i_bin++ )
1370 : {
1371 0 : Word32 w_fx = *( p_c_weights_fx++ ); // Q30
1372 0 : 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 0 : 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 0 : 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 0 : 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 0 : 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 0 : 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 0 : 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 0 : 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 0 : 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 0 : p_real_fx = Mpy_32_32( sec_w_real_fx, w_fx ); // ( Qfac - 2 ) + 30 - 31 = Qfac - 3
1389 0 : 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 0 : n1 = norm_l( p_real_fx );
1395 0 : n2 = norm_l( p_imag_fx );
1396 :
1397 0 : n = s_min( n1, n2 );
1398 :
1399 0 : p_real_fx = L_shl( p_real_fx, n );
1400 0 : p_imag_fx = L_shl( p_imag_fx, n );
1401 :
1402 0 : p_q = add( sub( Qfac, 3 ), n );
1403 :
1404 : Word16 tmp_exp, sec_sum_exp;
1405 0 : tmp_exp = sub( 66, add( p_q, Qfac ) ); // 31 - ( p_q + Qfac - 35 )
1406 :
1407 0 : 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 0 : 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 0 : 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 0 : *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 0 : move32();
1412 0 : *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 0 : move32();
1414 0 : *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 0 : move32();
1416 :
1417 : Word32 tmp1;
1418 : Word64 tmp2, tmp3, tmp4, sec_sum64;
1419 : Word32 tmp5, sec_sum;
1420 0 : tmp_exp = sub( 62, add( p_q, p_q ) );
1421 :
1422 0 : 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 0 : 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 0 : 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 0 : 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 0 : sec_sum64 = W_add( W_add( tmp2, tmp3 ), tmp4 ); // 2 * (Qfac - 2)
1427 0 : n = W_norm( sec_sum64 );
1428 0 : sec_sum64 = W_shl( sec_sum64, n ); // 2 * (Qfac - 2) + n
1429 0 : sec_sum = W_extract_h( sec_sum64 ); // 2 * (Qfac - 2) + n - 32 = 2 * Qfac + n - 36
1430 0 : sec_sum_exp = sub( 67, add( shl( Qfac, 1 ), n ) );
1431 :
1432 : // divide by 2:
1433 0 : tmp1 = L_shr( tmp1, 1 );
1434 0 : sec_sum = L_shr( sec_sum, 1 );
1435 :
1436 0 : tmp5 = BASOP_Util_Add_Mant32Exp( tmp1, tmp_exp, sec_sum, sec_sum_exp, &tmp_exp );
1437 0 : energy_fx = BASOP_Util_Add_Mant32Exp( energy_fx, energy_exp, tmp5, tmp_exp, &energy_exp );
1438 : }
1439 : }
1440 :
1441 0 : IF( hDirAC->firstrun_sector_params )
1442 : {
1443 0 : *p_sec_I_vec_smth_x_fx = *p_sec_I_vec_x_fx;
1444 0 : move32();
1445 0 : *p_sec_I_vec_smth_y_fx = *p_sec_I_vec_y_fx;
1446 0 : move32();
1447 0 : *p_sec_I_vec_smth_z_fx = *p_sec_I_vec_z_fx;
1448 0 : move32();
1449 0 : *p_energy_smth_fx = energy_fx;
1450 0 : move32();
1451 0 : *p_sec_I_vec_smth_x_exp = *p_sec_I_vec_x_exp;
1452 0 : move16();
1453 0 : *p_sec_I_vec_smth_y_exp = *p_sec_I_vec_y_exp;
1454 0 : move16();
1455 0 : *p_sec_I_vec_smth_z_exp = *p_sec_I_vec_z_exp;
1456 0 : move16();
1457 0 : *p_energy_smth_exp = energy_exp;
1458 0 : move16();
1459 : }
1460 : ELSE
1461 : {
1462 0 : Word32 w_fx = L_sub( ONE_IN_Q30, beta_fx ); // Q30
1463 :
1464 0 : *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 0 : move32();
1466 0 : *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 0 : move32();
1468 0 : *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 0 : move32();
1470 0 : *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 0 : IF( LT_32( energy_fx, EPSILON_FX_SMALL ) )
1474 : {
1475 0 : *p_azi_fx = 0;
1476 0 : move32();
1477 0 : *p_ele_fx = 0;
1478 0 : move32();
1479 0 : *p_ene_fx = 0;
1480 0 : move32();
1481 0 : *p_ene_exp = 0;
1482 0 : move16();
1483 0 : *p_diff_fx = ONE_IN_Q30;
1484 0 : move32();
1485 0 : *p_diff_exp = 1;
1486 0 : move16();
1487 : }
1488 : ELSE
1489 : {
1490 : Word32 tmp_x, tmp_y, tmp_z, tmp_xy_hypo, tmp32;
1491 : Word16 tmp16, tmp_e;
1492 0 : tmp_x = Mpy_32_32( *p_sec_I_vec_smth_x_fx, *p_sec_I_vec_smth_x_fx );
1493 0 : tmp_y = Mpy_32_32( *p_sec_I_vec_smth_y_fx, *p_sec_I_vec_smth_y_fx );
1494 0 : tmp_z = Mpy_32_32( *p_sec_I_vec_smth_z_fx, *p_sec_I_vec_smth_z_fx );
1495 0 : 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 0 : normI_fx = BASOP_Util_Add_Mant32Exp( tmp32, tmp_e, tmp_z, shl( *p_sec_I_vec_smth_z_exp, 1 ), &normI_exp );
1497 0 : normI_fx = Sqrt32( normI_fx, &normI_exp );
1498 :
1499 0 : tmp32 = BASOP_Util_Add_Mant32Exp( tmp32, tmp_e, 0, 0, &tmp_e ); // normalising value of tmp32
1500 0 : tmp_xy_hypo = Sqrt32( tmp32, &tmp_e ); // sqrt(x^2 + y^2)
1501 :
1502 0 : 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 0 : *p_azi_fx = Mpy_32_32( L_deposit_h( tmp16 ), _180_OVER_PI_Q25 ); // (Q13 + 16) + Q25 - 31 = 54 - 31 = Q23
1504 0 : move32();
1505 0 : 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 0 : *p_ele_fx = Mpy_32_32( L_deposit_h( tmp16 ), _180_OVER_PI_Q25 ); // (Q13 + 16) + Q25 - 31 = 54 - 31 = Q23
1507 0 : move32();
1508 0 : *p_ene_fx = *p_energy_smth_fx;
1509 0 : move32();
1510 0 : *p_ene_exp = *p_energy_smth_exp;
1511 0 : move16();
1512 :
1513 0 : tmp32 = L_deposit_h( BASOP_Util_Divide3232_Scale( normI_fx, L_add( *p_energy_smth_fx, EPSILON_FX_SMALL ), &tmp_e ) );
1514 0 : tmp_e = add( tmp_e, sub( normI_exp, *p_energy_smth_exp ) );
1515 0 : tmp32 = BASOP_Util_Add_Mant32Exp( ONE_IN_Q30, 1, L_negate( tmp32 ), tmp_e, &tmp_e );
1516 0 : *p_diff_fx = tmp32;
1517 0 : move32();
1518 0 : *p_diff_exp = tmp_e;
1519 0 : move16();
1520 : }
1521 :
1522 0 : tmp_diff_fx = *p_diff_fx;
1523 0 : move32();
1524 0 : tmp_diff_exp = *p_diff_exp;
1525 0 : move16();
1526 0 : if ( tmp_diff_fx < 0 )
1527 : {
1528 0 : tmp_diff_fx = 0;
1529 0 : move32();
1530 : }
1531 :
1532 0 : tmp_diff_fx = L_shr( tmp_diff_fx, sub( 2, tmp_diff_exp ) ); // Q29
1533 0 : tmp_diff_exp = 2;
1534 0 : move16();
1535 :
1536 0 : IF( GT_32( tmp_diff_fx, ONE_IN_Q28 ) )
1537 : {
1538 0 : IF( hDirAC->firstrun_sector_params )
1539 : {
1540 0 : *p_azi_fx = 0;
1541 0 : move32();
1542 0 : *p_ele_fx = 0;
1543 0 : move32();
1544 : }
1545 : ELSE
1546 : {
1547 0 : *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 0 : move32();
1549 0 : *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 0 : move32();
1551 0 : *p_azi_fx = L_shl( *p_azi_fx, 2 ); // Q21 -> Q23;
1552 0 : move32();
1553 0 : *p_ele_fx = L_shl( *p_ele_fx, 2 ); // Q21 -> Q23;
1554 0 : move32();
1555 : }
1556 : }
1557 : ELSE
1558 : {
1559 0 : *p_azi_prev_fx = *p_azi_fx;
1560 0 : move32();
1561 0 : *p_ele_prev_fx = *p_ele_fx;
1562 0 : move32();
1563 : }
1564 : }
1565 : }
1566 :
1567 0 : hDirAC->firstrun_sector_params = 0;
1568 0 : move16();
1569 :
1570 0 : 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 : }
|
