FreeCalypso > hg > gsm-codec-lib

comparison libtwamr/basicop2.c @ 252:57b4053559ff

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
libtwamr: beginning of project
author Mychaela Falconia <falcon@freecalypso.org>
date Fri, 05 Apr 2024 01:02:23 +0000
parents
children
comparison
equal deleted inserted replaced
251:946849291027 252:57b4053559ff
1 /*___________________________________________________________________________
2 | |
3 | Basic arithmetic operators. |
4 | |
5 | $Id $
6 |___________________________________________________________________________|
7 */
8
9 /*___________________________________________________________________________
10 | |
11 | Include-Files |
12 |___________________________________________________________________________|
13 */
14
15 #include <stdint.h>
16 #include "typedef.h"
17 #include "namespace.h"
18 #include "basic_op.h"
19
20 #if (WMOPS)
21 #include "count.h"
22 extern BASIC_OP multiCounter[MAXCOUNTERS];
23 extern int currCounter;
24 #endif
25
26 /*___________________________________________________________________________
27 | |
28 | Functions |
29 |___________________________________________________________________________|
30 */
31
32 /*___________________________________________________________________________
33 | |
34 | Function Name : saturate |
35 | |
36 | Purpose : |
37 | |
38 | Limit the 32 bit input to the range of a 16 bit word. |
39 | |
40 | Inputs : |
41 | |
42 | L_var1 |
43 | 32 bit long signed integer (Word32) whose value falls in the |
44 | range : 0x8000 0000 <= L_var1 <= 0x7fff ffff. |
45 | |
46 | Outputs : |
47 | |
48 | none |
49 | |
50 | Return Value : |
51 | |
52 | var_out |
53 | 16 bit short signed integer (Word16) whose value falls in the |
54 | range : 0xffff 8000 <= var_out <= 0x0000 7fff. |
55 |___________________________________________________________________________|
56 */
57
58 static inline Word16
59 saturate (Word32 L_var1)
60 {
61 Word16 var_out;
62
63 if (L_var1 > 0X00007fffL)
64 {
65 Overflow = 1;
66 var_out = MAX_16;
67 }
68 else if (L_var1 < (Word32) 0xffff8000L)
69 {
70 Overflow = 1;
71 var_out = MIN_16;
72 }
73 else
74 {
75 var_out = extract_l (L_var1);
76 #if (WMOPS)
77 multiCounter[currCounter].extract_l--;
78 #endif
79 }
80
81 return (var_out);
82 }
83
84 /*___________________________________________________________________________
85 | |
86 | Function Name : add |
87 | |
88 | Purpose : |
89 | |
90 | Performs the addition (var1+var2) with overflow control and saturation;|
91 | the 16 bit result is set at +32767 when overflow occurs or at -32768 |
92 | when underflow occurs. |
93 | |
94 | Complexity weight : 1 |
95 | |
96 | Inputs : |
97 | |
98 | var1 |
99 | 16 bit short signed integer (Word16) whose value falls in the |
100 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
101 | |
102 | var2 |
103 | 16 bit short signed integer (Word16) whose value falls in the |
104 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
105 | |
106 | Outputs : |
107 | |
108 | none |
109 | |
110 | Return Value : |
111 | |
112 | var_out |
113 | 16 bit short signed integer (Word16) whose value falls in the |
114 | range : 0xffff 8000 <= var_out <= 0x0000 7fff. |
115 |___________________________________________________________________________|
116 */
117
118 Word16 add (Word16 var1, Word16 var2)
119 {
120 Word16 var_out;
121 Word32 L_sum;
122
123 L_sum = (Word32) var1 + var2;
124 var_out = saturate (L_sum);
125 #if (WMOPS)
126 multiCounter[currCounter].add++;
127 #endif
128 return (var_out);
129 }
130
131 /*___________________________________________________________________________
132 | |
133 | Function Name : sub |
134 | |
135 | Purpose : |
136 | |
137 | Performs the subtraction (var1+var2) with overflow control and satu- |
138 | ration; the 16 bit result is set at +32767 when overflow occurs or at |
139 | -32768 when underflow occurs. |
140 | |
141 | Complexity weight : 1 |
142 | |
143 | Inputs : |
144 | |
145 | var1 |
146 | 16 bit short signed integer (Word16) whose value falls in the |
147 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
148 | |
149 | var2 |
150 | 16 bit short signed integer (Word16) whose value falls in the |
151 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
152 | |
153 | Outputs : |
154 | |
155 | none |
156 | |
157 | Return Value : |
158 | |
159 | var_out |
160 | 16 bit short signed integer (Word16) whose value falls in the |
161 | range : 0xffff 8000 <= var_out <= 0x0000 7fff. |
162 |___________________________________________________________________________|
163 */
164
165 Word16 sub (Word16 var1, Word16 var2)
166 {
167 Word16 var_out;
168 Word32 L_diff;
169
170 L_diff = (Word32) var1 - var2;
171 var_out = saturate (L_diff);
172 #if (WMOPS)
173 multiCounter[currCounter].sub++;
174 #endif
175 return (var_out);
176 }
177
178 /*___________________________________________________________________________
179 | |
180 | Function Name : abs_s |
181 | |
182 | Purpose : |
183 | |
184 | Absolute value of var1; abs_s(-32768) = 32767. |
185 | |
186 | Complexity weight : 1 |
187 | |
188 | Inputs : |
189 | |
190 | var1 |
191 | 16 bit short signed integer (Word16) whose value falls in the |
192 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
193 | |
194 | Outputs : |
195 | |
196 | none |
197 | |
198 | Return Value : |
199 | |
200 | var_out |
201 | 16 bit short signed integer (Word16) whose value falls in the |
202 | range : 0x0000 0000 <= var_out <= 0x0000 7fff. |
203 |___________________________________________________________________________|
204 */
205
206 Word16 abs_s (Word16 var1)
207 {
208 Word16 var_out;
209
210 if (var1 == (Word16) 0X8000)
211 {
212 var_out = MAX_16;
213 }
214 else
215 {
216 if (var1 < 0)
217 {
218 var_out = -var1;
219 }
220 else
221 {
222 var_out = var1;
223 }
224 }
225 #if (WMOPS)
226 multiCounter[currCounter].abs_s++;
227 #endif
228 return (var_out);
229 }
230
231 /*___________________________________________________________________________
232 | |
233 | Function Name : shl |
234 | |
235 | Purpose : |
236 | |
237 | Arithmetically shift the 16 bit input var1 left var2 positions.Zero fill|
238 | the var2 LSB of the result. If var2 is negative, arithmetically shift |
239 | var1 right by -var2 with sign extension. Saturate the result in case of |
240 | underflows or overflows. |
241 | |
242 | Complexity weight : 1 |
243 | |
244 | Inputs : |
245 | |
246 | var1 |
247 | 16 bit short signed integer (Word16) whose value falls in the |
248 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
249 | |
250 | var2 |
251 | 16 bit short signed integer (Word16) whose value falls in the |
252 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
253 | |
254 | Outputs : |
255 | |
256 | none |
257 | |
258 | Return Value : |
259 | |
260 | var_out |
261 | 16 bit short signed integer (Word16) whose value falls in the |
262 | range : 0xffff 8000 <= var_out <= 0x0000 7fff. |
263 |___________________________________________________________________________|
264 */
265
266 Word16 shl (Word16 var1, Word16 var2)
267 {
268 Word16 var_out;
269 Word32 result;
270
271 if (var2 < 0)
272 {
273 if (var2 < -16)
274 var2 = -16;
275 var_out = shr (var1, -var2);
276 #if (WMOPS)
277 multiCounter[currCounter].shr--;
278 #endif
279 }
280 else
281 {
282 result = (Word32) var1 *((Word32) 1 << var2);
283
284 if ((var2 > 15 && var1 != 0) || (result != (Word32) ((Word16) result)))
285 {
286 Overflow = 1;
287 var_out = (var1 > 0) ? MAX_16 : MIN_16;
288 }
289 else
290 {
291 var_out = extract_l (result);
292 #if (WMOPS)
293 multiCounter[currCounter].extract_l--;
294 #endif
295 }
296 }
297 #if (WMOPS)
298 multiCounter[currCounter].shl++;
299 #endif
300 return (var_out);
301 }
302
303 /*___________________________________________________________________________
304 | |
305 | Function Name : shr |
306 | |
307 | Purpose : |
308 | |
309 | Arithmetically shift the 16 bit input var1 right var2 positions with |
310 | sign extension. If var2 is negative, arithmetically shift var1 left by |
311 | -var2 with sign extension. Saturate the result in case of underflows or |
312 | overflows. |
313 | |
314 | Complexity weight : 1 |
315 | |
316 | Inputs : |
317 | |
318 | var1 |
319 | 16 bit short signed integer (Word16) whose value falls in the |
320 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
321 | |
322 | var2 |
323 | 16 bit short signed integer (Word16) whose value falls in the |
324 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
325 | |
326 | Outputs : |
327 | |
328 | none |
329 | |
330 | Return Value : |
331 | |
332 | var_out |
333 | 16 bit short signed integer (Word16) whose value falls in the |
334 | range : 0xffff 8000 <= var_out <= 0x0000 7fff. |
335 |___________________________________________________________________________|
336 */
337
338 Word16 shr (Word16 var1, Word16 var2)
339 {
340 Word16 var_out;
341
342 if (var2 < 0)
343 {
344 if (var2 < -16)
345 var2 = -16;
346 var_out = shl (var1, -var2);
347 #if (WMOPS)
348 multiCounter[currCounter].shl--;
349 #endif
350 }
351 else
352 {
353 if (var2 >= 15)
354 {
355 var_out = (var1 < 0) ? -1 : 0;
356 }
357 else
358 {
359 if (var1 < 0)
360 {
361 var_out = ~((~var1) >> var2);
362 }
363 else
364 {
365 var_out = var1 >> var2;
366 }
367 }
368 }
369
370 #if (WMOPS)
371 multiCounter[currCounter].shr++;
372 #endif
373 return (var_out);
374 }
375
376 /*___________________________________________________________________________
377 | |
378 | Function Name : mult |
379 | |
380 | Purpose : |
381 | |
382 | Performs the multiplication of var1 by var2 and gives a 16 bit result |
383 | which is scaled i.e.: |
384 | mult(var1,var2) = extract_l(L_shr((var1 times var2),15)) and |
385 | mult(-32768,-32768) = 32767. |
386 | |
387 | Complexity weight : 1 |
388 | |
389 | Inputs : |
390 | |
391 | var1 |
392 | 16 bit short signed integer (Word16) whose value falls in the |
393 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
394 | |
395 | var2 |
396 | 16 bit short signed integer (Word16) whose value falls in the |
397 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
398 | |
399 | Outputs : |
400 | |
401 | none |
402 | |
403 | Return Value : |
404 | |
405 | var_out |
406 | 16 bit short signed integer (Word16) whose value falls in the |
407 | range : 0xffff 8000 <= var_out <= 0x0000 7fff. |
408 |___________________________________________________________________________|
409 */
410
411 Word16 mult (Word16 var1, Word16 var2)
412 {
413 Word16 var_out;
414 Word32 L_product;
415
416 L_product = (Word32) var1 *(Word32) var2;
417
418 L_product = (L_product & (Word32) 0xffff8000L) >> 15;
419
420 if (L_product & (Word32) 0x00010000L)
421 L_product = L_product | (Word32) 0xffff0000L;
422
423 var_out = saturate (L_product);
424 #if (WMOPS)
425 multiCounter[currCounter].mult++;
426 #endif
427 return (var_out);
428 }
429
430 /*___________________________________________________________________________
431 | |
432 | Function Name : L_mult |
433 | |
434 | Purpose : |
435 | |
436 | L_mult is the 32 bit result of the multiplication of var1 times var2 |
437 | with one shift left i.e.: |
438 | L_mult(var1,var2) = L_shl((var1 times var2),1) and |
439 | L_mult(-32768,-32768) = 2147483647. |
440 | |
441 | Complexity weight : 1 |
442 | |
443 | Inputs : |
444 | |
445 | var1 |
446 | 16 bit short signed integer (Word16) whose value falls in the |
447 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
448 | |
449 | var2 |
450 | 16 bit short signed integer (Word16) whose value falls in the |
451 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
452 | |
453 | Outputs : |
454 | |
455 | none |
456 | |
457 | Return Value : |
458 | |
459 | L_var_out |
460 | 32 bit long signed integer (Word32) whose value falls in the |
461 | range : 0x8000 0000 <= L_var_out <= 0x7fff ffff. |
462 |___________________________________________________________________________|
463 */
464
465 Word32 L_mult (Word16 var1, Word16 var2)
466 {
467 Word32 L_var_out;
468
469 L_var_out = (Word32) var1 *(Word32) var2;
470
471 if (L_var_out != (Word32) 0x40000000L)
472 {
473 L_var_out *= 2;
474 }
475 else
476 {
477 Overflow = 1;
478 L_var_out = MAX_32;
479 }
480
481 #if (WMOPS)
482 multiCounter[currCounter].L_mult++;
483 #endif
484 return (L_var_out);
485 }
486
487 /*___________________________________________________________________________
488 | |
489 | Function Name : negate |
490 | |
491 | Purpose : |
492 | |
493 | Negate var1 with saturation, saturate in the case where input is -32768:|
494 | negate(var1) = sub(0,var1). |
495 | |
496 | Complexity weight : 1 |
497 | |
498 | Inputs : |
499 | |
500 | var1 |
501 | 16 bit short signed integer (Word16) whose value falls in the |
502 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
503 | |
504 | Outputs : |
505 | |
506 | none |
507 | |
508 | Return Value : |
509 | |
510 | var_out |
511 | 16 bit short signed integer (Word16) whose value falls in the |
512 | range : 0xffff 8000 <= var_out <= 0x0000 7fff. |
513 |___________________________________________________________________________|
514 */
515
516 Word16 negate (Word16 var1)
517 {
518 Word16 var_out;
519
520 var_out = (var1 == MIN_16) ? MAX_16 : -var1;
521 #if (WMOPS)
522 multiCounter[currCounter].negate++;
523 #endif
524 return (var_out);
525 }
526
527 /*___________________________________________________________________________
528 | |
529 | Function Name : extract_h |
530 | |
531 | Purpose : |
532 | |
533 | Return the 16 MSB of L_var1. |
534 | |
535 | Complexity weight : 1 |
536 | |
537 | Inputs : |
538 | |
539 | L_var1 |
540 | 32 bit long signed integer (Word32 ) whose value falls in the |
541 | range : 0x8000 0000 <= L_var1 <= 0x7fff ffff. |
542 | |
543 | Outputs : |
544 | |
545 | none |
546 | |
547 | Return Value : |
548 | |
549 | var_out |
550 | 16 bit short signed integer (Word16) whose value falls in the |
551 | range : 0xffff 8000 <= var_out <= 0x0000 7fff. |
552 |___________________________________________________________________________|
553 */
554
555 Word16 extract_h (Word32 L_var1)
556 {
557 Word16 var_out;
558
559 var_out = (Word16) (L_var1 >> 16);
560 #if (WMOPS)
561 multiCounter[currCounter].extract_h++;
562 #endif
563 return (var_out);
564 }
565
566 /*___________________________________________________________________________
567 | |
568 | Function Name : extract_l |
569 | |
570 | Purpose : |
571 | |
572 | Return the 16 LSB of L_var1. |
573 | |
574 | Complexity weight : 1 |
575 | |
576 | Inputs : |
577 | |
578 | L_var1 |
579 | 32 bit long signed integer (Word32 ) whose value falls in the |
580 | range : 0x8000 0000 <= L_var1 <= 0x7fff ffff. |
581 | |
582 | Outputs : |
583 | |
584 | none |
585 | |
586 | Return Value : |
587 | |
588 | var_out |
589 | 16 bit short signed integer (Word16) whose value falls in the |
590 | range : 0xffff 8000 <= var_out <= 0x0000 7fff. |
591 |___________________________________________________________________________|
592 */
593
594 Word16 extract_l (Word32 L_var1)
595 {
596 Word16 var_out;
597
598 var_out = (Word16) L_var1;
599 #if (WMOPS)
600 multiCounter[currCounter].extract_l++;
601 #endif
602 return (var_out);
603 }
604
605 /*___________________________________________________________________________
606 | |
607 | Function Name : round |
608 | |
609 | Purpose : |
610 | |
611 | Round the lower 16 bits of the 32 bit input number into the MS 16 bits |
612 | with saturation. Shift the resulting bits right by 16 and return the 16 |
613 | bit number: |
614 | round(L_var1) = extract_h(L_add(L_var1,32768)) |
615 | |
616 | Complexity weight : 1 |
617 | |
618 | Inputs : |
619 | |
620 | L_var1 |
621 | 32 bit long signed integer (Word32 ) whose value falls in the |
622 | range : 0x8000 0000 <= L_var1 <= 0x7fff ffff. |
623 | |
624 | Outputs : |
625 | |
626 | none |
627 | |
628 | Return Value : |
629 | |
630 | var_out |
631 | 16 bit short signed integer (Word16) whose value falls in the |
632 | range : 0xffff 8000 <= var_out <= 0x0000 7fff. |
633 |___________________________________________________________________________|
634 */
635
636 Word16 round (Word32 L_var1)
637 {
638 Word16 var_out;
639 Word32 L_rounded;
640
641 L_rounded = L_add (L_var1, (Word32) 0x00008000L);
642 #if (WMOPS)
643 multiCounter[currCounter].L_add--;
644 #endif
645 var_out = extract_h (L_rounded);
646 #if (WMOPS)
647 multiCounter[currCounter].extract_h--;
648 multiCounter[currCounter].round++;
649 #endif
650 return (var_out);
651 }
652
653 /*___________________________________________________________________________
654 | |
655 | Function Name : L_mac |
656 | |
657 | Purpose : |
658 | |
659 | Multiply var1 by var2 and shift the result left by 1. Add the 32 bit |
660 | result to L_var3 with saturation, return a 32 bit result: |
661 | L_mac(L_var3,var1,var2) = L_add(L_var3,L_mult(var1,var2)). |
662 | |
663 | Complexity weight : 1 |
664 | |
665 | Inputs : |
666 | |
667 | L_var3 32 bit long signed integer (Word32) whose value falls in the |
668 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
669 | |
670 | var1 |
671 | 16 bit short signed integer (Word16) whose value falls in the |
672 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
673 | |
674 | var2 |
675 | 16 bit short signed integer (Word16) whose value falls in the |
676 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
677 | |
678 | Outputs : |
679 | |
680 | none |
681 | |
682 | Return Value : |
683 | |
684 | L_var_out |
685 | 32 bit long signed integer (Word32) whose value falls in the |
686 | range : 0x8000 0000 <= L_var_out <= 0x7fff ffff. |
687 |___________________________________________________________________________|
688 */
689
690 Word32 L_mac (Word32 L_var3, Word16 var1, Word16 var2)
691 {
692 Word32 L_var_out;
693 Word32 L_product;
694
695 L_product = L_mult (var1, var2);
696 #if (WMOPS)
697 multiCounter[currCounter].L_mult--;
698 #endif
699 L_var_out = L_add (L_var3, L_product);
700 #if (WMOPS)
701 multiCounter[currCounter].L_add--;
702 multiCounter[currCounter].L_mac++;
703 #endif
704 return (L_var_out);
705 }
706
707 /*___________________________________________________________________________
708 | |
709 | Function Name : L_msu |
710 | |
711 | Purpose : |
712 | |
713 | Multiply var1 by var2 and shift the result left by 1. Subtract the 32 |
714 | bit result to L_var3 with saturation, return a 32 bit result: |
715 | L_msu(L_var3,var1,var2) = L_sub(L_var3,L_mult(var1,var2)). |
716 | |
717 | Complexity weight : 1 |
718 | |
719 | Inputs : |
720 | |
721 | L_var3 32 bit long signed integer (Word32) whose value falls in the |
722 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
723 | |
724 | var1 |
725 | 16 bit short signed integer (Word16) whose value falls in the |
726 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
727 | |
728 | var2 |
729 | 16 bit short signed integer (Word16) whose value falls in the |
730 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
731 | |
732 | Outputs : |
733 | |
734 | none |
735 | |
736 | Return Value : |
737 | |
738 | L_var_out |
739 | 32 bit long signed integer (Word32) whose value falls in the |
740 | range : 0x8000 0000 <= L_var_out <= 0x7fff ffff. |
741 |___________________________________________________________________________|
742 */
743
744 Word32 L_msu (Word32 L_var3, Word16 var1, Word16 var2)
745 {
746 Word32 L_var_out;
747 Word32 L_product;
748
749 L_product = L_mult (var1, var2);
750 #if (WMOPS)
751 multiCounter[currCounter].L_mult--;
752 #endif
753 L_var_out = L_sub (L_var3, L_product);
754 #if (WMOPS)
755 multiCounter[currCounter].L_sub--;
756 multiCounter[currCounter].L_msu++;
757 #endif
758 return (L_var_out);
759 }
760
761 /*___________________________________________________________________________
762 | |
763 | Function Name : L_macNs |
764 | |
765 | Purpose : |
766 | |
767 | Multiply var1 by var2 and shift the result left by 1. Add the 32 bit |
768 | result to L_var3 without saturation, return a 32 bit result. Generate |
769 | carry and overflow values : |
770 | L_macNs(L_var3,var1,var2) = L_add_c(L_var3,L_mult(var1,var2)). |
771 | |
772 | Complexity weight : 1 |
773 | |
774 | Inputs : |
775 | |
776 | L_var3 32 bit long signed integer (Word32) whose value falls in the |
777 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
778 | |
779 | var1 |
780 | 16 bit short signed integer (Word16) whose value falls in the |
781 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
782 | |
783 | var2 |
784 | 16 bit short signed integer (Word16) whose value falls in the |
785 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
786 | |
787 | Outputs : |
788 | |
789 | none |
790 | |
791 | Return Value : |
792 | |
793 | L_var_out |
794 | 32 bit long signed integer (Word32) whose value falls in the |
795 | range : 0x8000 0000 <= L_var_out <= 0x7fff ffff. |
796 | |
797 | Caution : |
798 | |
799 | In some cases the Carry flag has to be cleared or set before using |
800 | operators which take into account its value. |
801 |___________________________________________________________________________|
802 */
803
804 Word32 L_macNs (Word32 L_var3, Word16 var1, Word16 var2)
805 {
806 Word32 L_var_out;
807
808 L_var_out = L_mult (var1, var2);
809 #if (WMOPS)
810 multiCounter[currCounter].L_mult--;
811 #endif
812 L_var_out = L_add_c (L_var3, L_var_out);
813 #if (WMOPS)
814 multiCounter[currCounter].L_add_c--;
815 multiCounter[currCounter].L_macNs++;
816 #endif
817 return (L_var_out);
818 }
819
820 /*___________________________________________________________________________
821 | |
822 | Function Name : L_msuNs |
823 | |
824 | Purpose : |
825 | |
826 | Multiply var1 by var2 and shift the result left by 1. Subtract the 32 |
827 | bit result from L_var3 without saturation, return a 32 bit result. Ge- |
828 | nerate carry and overflow values : |
829 | L_msuNs(L_var3,var1,var2) = L_sub_c(L_var3,L_mult(var1,var2)). |
830 | |
831 | Complexity weight : 1 |
832 | |
833 | Inputs : |
834 | |
835 | L_var3 32 bit long signed integer (Word32) whose value falls in the |
836 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
837 | |
838 | var1 |
839 | 16 bit short signed integer (Word16) whose value falls in the |
840 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
841 | |
842 | var2 |
843 | 16 bit short signed integer (Word16) whose value falls in the |
844 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
845 | |
846 | Outputs : |
847 | |
848 | none |
849 | |
850 | Return Value : |
851 | |
852 | L_var_out |
853 | 32 bit long signed integer (Word32) whose value falls in the |
854 | range : 0x8000 0000 <= L_var_out <= 0x7fff ffff. |
855 | |
856 | Caution : |
857 | |
858 | In some cases the Carry flag has to be cleared or set before using |
859 | operators which take into account its value. |
860 |___________________________________________________________________________|
861 */
862
863 Word32 L_msuNs (Word32 L_var3, Word16 var1, Word16 var2)
864 {
865 Word32 L_var_out;
866
867 L_var_out = L_mult (var1, var2);
868 #if (WMOPS)
869 multiCounter[currCounter].L_mult--;
870 #endif
871 L_var_out = L_sub_c (L_var3, L_var_out);
872 #if (WMOPS)
873 multiCounter[currCounter].L_sub_c--;
874 multiCounter[currCounter].L_msuNs++;
875 #endif
876 return (L_var_out);
877 }
878
879 /*___________________________________________________________________________
880 | |
881 | Function Name : L_add |
882 | |
883 | Purpose : |
884 | |
885 | 32 bits addition of the two 32 bits variables (L_var1+L_var2) with |
886 | overflow control and saturation; the result is set at +2147483647 when |
887 | overflow occurs or at -2147483648 when underflow occurs. |
888 | |
889 | Complexity weight : 2 |
890 | |
891 | Inputs : |
892 | |
893 | L_var1 32 bit long signed integer (Word32) whose value falls in the |
894 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
895 | |
896 | L_var2 32 bit long signed integer (Word32) whose value falls in the |
897 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
898 | |
899 | Outputs : |
900 | |
901 | none |
902 | |
903 | Return Value : |
904 | |
905 | L_var_out |
906 | 32 bit long signed integer (Word32) whose value falls in the |
907 | range : 0x8000 0000 <= L_var_out <= 0x7fff ffff. |
908 |___________________________________________________________________________|
909 */
910
911 Word32 L_add (Word32 L_var1, Word32 L_var2)
912 {
913 Word32 L_var_out;
914
915 L_var_out = L_var1 + L_var2;
916
917 if (((L_var1 ^ L_var2) & MIN_32) == 0)
918 {
919 if ((L_var_out ^ L_var1) & MIN_32)
920 {
921 L_var_out = (L_var1 < 0) ? MIN_32 : MAX_32;
922 Overflow = 1;
923 }
924 }
925 #if (WMOPS)
926 multiCounter[currCounter].L_add++;
927 #endif
928 return (L_var_out);
929 }
930
931 /*___________________________________________________________________________
932 | |
933 | Function Name : L_sub |
934 | |
935 | Purpose : |
936 | |
937 | 32 bits subtraction of the two 32 bits variables (L_var1-L_var2) with |
938 | overflow control and saturation; the result is set at +2147483647 when |
939 | overflow occurs or at -2147483648 when underflow occurs. |
940 | |
941 | Complexity weight : 2 |
942 | |
943 | Inputs : |
944 | |
945 | L_var1 32 bit long signed integer (Word32) whose value falls in the |
946 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
947 | |
948 | L_var2 32 bit long signed integer (Word32) whose value falls in the |
949 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
950 | |
951 | Outputs : |
952 | |
953 | none |
954 | |
955 | Return Value : |
956 | |
957 | L_var_out |
958 | 32 bit long signed integer (Word32) whose value falls in the |
959 | range : 0x8000 0000 <= L_var_out <= 0x7fff ffff. |
960 |___________________________________________________________________________|
961 */
962
963 Word32 L_sub (Word32 L_var1, Word32 L_var2)
964 {
965 Word32 L_var_out;
966
967 L_var_out = L_var1 - L_var2;
968
969 if (((L_var1 ^ L_var2) & MIN_32) != 0)
970 {
971 if ((L_var_out ^ L_var1) & MIN_32)
972 {
973 L_var_out = (L_var1 < 0L) ? MIN_32 : MAX_32;
974 Overflow = 1;
975 }
976 }
977 #if (WMOPS)
978 multiCounter[currCounter].L_sub++;
979 #endif
980 return (L_var_out);
981 }
982
983 /*___________________________________________________________________________
984 | |
985 | Function Name : L_add_c |
986 | |
987 | Purpose : |
988 | |
989 | Performs 32 bits addition of the two 32 bits variables (L_var1+L_var2+C)|
990 | with carry. No saturation. Generate carry and Overflow values. The car- |
991 | ry and overflow values are binary variables which can be tested and as- |
992 | signed values. |
993 | |
994 | Complexity weight : 2 |
995 | |
996 | Inputs : |
997 | |
998 | L_var1 32 bit long signed integer (Word32) whose value falls in the |
999 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
1000 | |
1001 | L_var2 32 bit long signed integer (Word32) whose value falls in the |
1002 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
1003 | |
1004 | Outputs : |
1005 | |
1006 | none |
1007 | |
1008 | Return Value : |
1009 | |
1010 | L_var_out |
1011 | 32 bit long signed integer (Word32) whose value falls in the |
1012 | range : 0x8000 0000 <= L_var_out <= 0x7fff ffff. |
1013 | |
1014 | Caution : |
1015 | |
1016 | In some cases the Carry flag has to be cleared or set before using |
1017 | operators which take into account its value. |
1018 |___________________________________________________________________________|
1019 */
1020 Word32 L_add_c (Word32 L_var1, Word32 L_var2)
1021 {
1022 Word32 L_var_out;
1023 Word32 L_test;
1024 Flag carry_int = 0;
1025
1026 L_var_out = L_var1 + L_var2 + Carry;
1027
1028 L_test = L_var1 + L_var2;
1029
1030 if ((L_var1 > 0) && (L_var2 > 0) && (L_test < 0))
1031 {
1032 Overflow = 1;
1033 carry_int = 0;
1034 }
1035 else
1036 {
1037 if ((L_var1 < 0) && (L_var2 < 0))
1038 {
1039 if (L_test >= 0)
1040 {
1041 Overflow = 1;
1042 carry_int = 1;
1043 }
1044 else
1045 {
1046 Overflow = 0;
1047 carry_int = 1;
1048 }
1049 }
1050 else
1051 {
1052 if (((L_var1 ^ L_var2) < 0) && (L_test >= 0))
1053 {
1054 Overflow = 0;
1055 carry_int = 1;
1056 }
1057 else
1058 {
1059 Overflow = 0;
1060 carry_int = 0;
1061 }
1062 }
1063 }
1064
1065 if (Carry)
1066 {
1067 if (L_test == MAX_32)
1068 {
1069 Overflow = 1;
1070 Carry = carry_int;
1071 }
1072 else
1073 {
1074 if (L_test == (Word32) 0xFFFFFFFFL)
1075 {
1076 Carry = 1;
1077 }
1078 else
1079 {
1080 Carry = carry_int;
1081 }
1082 }
1083 }
1084 else
1085 {
1086 Carry = carry_int;
1087 }
1088
1089 #if (WMOPS)
1090 multiCounter[currCounter].L_add_c++;
1091 #endif
1092 return (L_var_out);
1093 }
1094
1095 /*___________________________________________________________________________
1096 | |
1097 | Function Name : L_sub_c |
1098 | |
1099 | Purpose : |
1100 | |
1101 | Performs 32 bits subtraction of the two 32 bits variables with carry |
1102 | (borrow) : L_var1-L_var2-C. No saturation. Generate carry and Overflow |
1103 | values. The carry and overflow values are binary variables which can |
1104 | be tested and assigned values. |
1105 | |
1106 | Complexity weight : 2 |
1107 | |
1108 | Inputs : |
1109 | |
1110 | L_var1 32 bit long signed integer (Word32) whose value falls in the |
1111 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
1112 | |
1113 | L_var2 32 bit long signed integer (Word32) whose value falls in the |
1114 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
1115 | |
1116 | Outputs : |
1117 | |
1118 | none |
1119 | |
1120 | Return Value : |
1121 | |
1122 | L_var_out |
1123 | 32 bit long signed integer (Word32) whose value falls in the |
1124 | range : 0x8000 0000 <= L_var_out <= 0x7fff ffff. |
1125 | |
1126 | Caution : |
1127 | |
1128 | In some cases the Carry flag has to be cleared or set before using |
1129 | operators which take into account its value. |
1130 |___________________________________________________________________________|
1131 */
1132
1133 Word32 L_sub_c (Word32 L_var1, Word32 L_var2)
1134 {
1135 Word32 L_var_out;
1136 Word32 L_test;
1137 Flag carry_int = 0;
1138
1139 if (Carry)
1140 {
1141 Carry = 0;
1142 if (L_var2 != MIN_32)
1143 {
1144 L_var_out = L_add_c (L_var1, -L_var2);
1145 #if (WMOPS)
1146 multiCounter[currCounter].L_add_c--;
1147 #endif
1148 }
1149 else
1150 {
1151 L_var_out = L_var1 - L_var2;
1152 if (L_var1 > 0L)
1153 {
1154 Overflow = 1;
1155 Carry = 0;
1156 }
1157 }
1158 }
1159 else
1160 {
1161 L_var_out = L_var1 - L_var2 - (Word32) 0X00000001L;
1162 L_test = L_var1 - L_var2;
1163
1164 if ((L_test < 0) && (L_var1 > 0) && (L_var2 < 0))
1165 {
1166 Overflow = 1;
1167 carry_int = 0;
1168 }
1169 else if ((L_test > 0) && (L_var1 < 0) && (L_var2 > 0))
1170 {
1171 Overflow = 1;
1172 carry_int = 1;
1173 }
1174 else if ((L_test > 0) && ((L_var1 ^ L_var2) > 0))
1175 {
1176 Overflow = 0;
1177 carry_int = 1;
1178 }
1179 if (L_test == MIN_32)
1180 {
1181 Overflow = 1;
1182 Carry = carry_int;
1183 }
1184 else
1185 {
1186 Carry = carry_int;
1187 }
1188 }
1189
1190 #if (WMOPS)
1191 multiCounter[currCounter].L_sub_c++;
1192 #endif
1193 return (L_var_out);
1194 }
1195
1196 /*___________________________________________________________________________
1197 | |
1198 | Function Name : L_negate |
1199 | |
1200 | Purpose : |
1201 | |
1202 | Negate the 32 bit variable L_var1 with saturation; saturate in the case |
1203 | where input is -2147483648 (0x8000 0000). |
1204 | |
1205 | Complexity weight : 2 |
1206 | |
1207 | Inputs : |
1208 | |
1209 | L_var1 32 bit long signed integer (Word32) whose value falls in the |
1210 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
1211 | |
1212 | Outputs : |
1213 | |
1214 | none |
1215 | |
1216 | Return Value : |
1217 | |
1218 | L_var_out |
1219 | 32 bit long signed integer (Word32) whose value falls in the |
1220 | range : 0x8000 0000 <= L_var_out <= 0x7fff ffff. |
1221 |___________________________________________________________________________|
1222 */
1223
1224 Word32 L_negate (Word32 L_var1)
1225 {
1226 Word32 L_var_out;
1227
1228 L_var_out = (L_var1 == MIN_32) ? MAX_32 : -L_var1;
1229 #if (WMOPS)
1230 multiCounter[currCounter].L_negate++;
1231 #endif
1232 return (L_var_out);
1233 }
1234
1235 /*___________________________________________________________________________
1236 | |
1237 | Function Name : mult_r |
1238 | |
1239 | Purpose : |
1240 | |
1241 | Same as mult with rounding, i.e.: |
1242 | mult_r(var1,var2) = extract_l(L_shr(((var1 * var2) + 16384),15)) and |
1243 | mult_r(-32768,-32768) = 32767. |
1244 | |
1245 | Complexity weight : 2 |
1246 | |
1247 | Inputs : |
1248 | |
1249 | var1 |
1250 | 16 bit short signed integer (Word16) whose value falls in the |
1251 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
1252 | |
1253 | var2 |
1254 | 16 bit short signed integer (Word16) whose value falls in the |
1255 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
1256 | |
1257 | Outputs : |
1258 | |
1259 | none |
1260 | |
1261 | Return Value : |
1262 | |
1263 | var_out |
1264 | 16 bit short signed integer (Word16) whose value falls in the |
1265 | range : 0xffff 8000 <= var_out <= 0x0000 7fff. |
1266 |___________________________________________________________________________|
1267 */
1268
1269 Word16 mult_r (Word16 var1, Word16 var2)
1270 {
1271 Word16 var_out;
1272 Word32 L_product_arr;
1273
1274 L_product_arr = (Word32) var1 *(Word32) var2; /* product */
1275 L_product_arr += (Word32) 0x00004000L; /* round */
1276 L_product_arr &= (Word32) 0xffff8000L;
1277 L_product_arr >>= 15; /* shift */
1278
1279 if (L_product_arr & (Word32) 0x00010000L) /* sign extend when necessary */
1280 {
1281 L_product_arr |= (Word32) 0xffff0000L;
1282 }
1283 var_out = saturate (L_product_arr);
1284 #if (WMOPS)
1285 multiCounter[currCounter].mult_r++;
1286 #endif
1287 return (var_out);
1288 }
1289
1290 /*___________________________________________________________________________
1291 | |
1292 | Function Name : L_shl |
1293 | |
1294 | Purpose : |
1295 | |
1296 | Arithmetically shift the 32 bit input L_var1 left var2 positions. Zero |
1297 | fill the var2 LSB of the result. If var2 is negative, arithmetically |
1298 | shift L_var1 right by -var2 with sign extension. Saturate the result in |
1299 | case of underflows or overflows. |
1300 | |
1301 | Complexity weight : 2 |
1302 | |
1303 | Inputs : |
1304 | |
1305 | L_var1 32 bit long signed integer (Word32) whose value falls in the |
1306 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
1307 | |
1308 | var2 |
1309 | 16 bit short signed integer (Word16) whose value falls in the |
1310 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
1311 | |
1312 | Outputs : |
1313 | |
1314 | none |
1315 | |
1316 | Return Value : |
1317 | |
1318 | L_var_out |
1319 | 32 bit long signed integer (Word32) whose value falls in the |
1320 | range : 0x8000 0000 <= L_var_out <= 0x7fff ffff. |
1321 |___________________________________________________________________________|
1322 */
1323
1324 Word32 L_shl (Word32 L_var1, Word16 var2)
1325 {
1326 Word32 L_var_out;
1327
1328 if (var2 <= 0)
1329 {
1330 if (var2 < -32)
1331 var2 = -32;
1332 L_var_out = L_shr (L_var1, -var2);
1333 #if (WMOPS)
1334 multiCounter[currCounter].L_shr--;
1335 #endif
1336 }
1337 else
1338 {
1339 for (; var2 > 0; var2--)
1340 {
1341 if (L_var1 > (Word32) 0X3fffffffL)
1342 {
1343 Overflow = 1;
1344 L_var_out = MAX_32;
1345 break;
1346 }
1347 else
1348 {
1349 if (L_var1 < (Word32) 0xc0000000L)
1350 {
1351 Overflow = 1;
1352 L_var_out = MIN_32;
1353 break;
1354 }
1355 }
1356 L_var1 *= 2;
1357 L_var_out = L_var1;
1358 }
1359 }
1360 #if (WMOPS)
1361 multiCounter[currCounter].L_shl++;
1362 #endif
1363 return (L_var_out);
1364 }
1365
1366 /*___________________________________________________________________________
1367 | |
1368 | Function Name : L_shr |
1369 | |
1370 | Purpose : |
1371 | |
1372 | Arithmetically shift the 32 bit input L_var1 right var2 positions with |
1373 | sign extension. If var2 is negative, arithmetically shift L_var1 left |
1374 | by -var2 and zero fill the -var2 LSB of the result. Saturate the result |
1375 | in case of underflows or overflows. |
1376 | |
1377 | Complexity weight : 2 |
1378 | |
1379 | Inputs : |
1380 | |
1381 | L_var1 32 bit long signed integer (Word32) whose value falls in the |
1382 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
1383 | |
1384 | var2 |
1385 | 16 bit short signed integer (Word16) whose value falls in the |
1386 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
1387 | |
1388 | Outputs : |
1389 | |
1390 | none |
1391 | |
1392 | Return Value : |
1393 | |
1394 | L_var_out |
1395 | 32 bit long signed integer (Word32) whose value falls in the |
1396 | range : 0x8000 0000 <= L_var_out <= 0x7fff ffff. |
1397 |___________________________________________________________________________|
1398 */
1399
1400 Word32 L_shr (Word32 L_var1, Word16 var2)
1401 {
1402 Word32 L_var_out;
1403
1404 if (var2 < 0)
1405 {
1406 if (var2 < -32)
1407 var2 = -32;
1408 L_var_out = L_shl (L_var1, -var2);
1409 #if (WMOPS)
1410 multiCounter[currCounter].L_shl--;
1411 #endif
1412 }
1413 else
1414 {
1415 if (var2 >= 31)
1416 {
1417 L_var_out = (L_var1 < 0L) ? -1 : 0;
1418 }
1419 else
1420 {
1421 if (L_var1 < 0)
1422 {
1423 L_var_out = ~((~L_var1) >> var2);
1424 }
1425 else
1426 {
1427 L_var_out = L_var1 >> var2;
1428 }
1429 }
1430 }
1431 #if (WMOPS)
1432 multiCounter[currCounter].L_shr++;
1433 #endif
1434 return (L_var_out);
1435 }
1436
1437 /*___________________________________________________________________________
1438 | |
1439 | Function Name : shr_r |
1440 | |
1441 | Purpose : |
1442 | |
1443 | Same as shr(var1,var2) but with rounding. Saturate the result in case of|
1444 | underflows or overflows : |
1445 | - If var2 is greater than zero : |
1446 | if (sub(shl(shr(var1,var2),1),shr(var1,sub(var2,1)))) |
1447 | is equal to zero |
1448 | then |
1449 | shr_r(var1,var2) = shr(var1,var2) |
1450 | else |
1451 | shr_r(var1,var2) = add(shr(var1,var2),1) |
1452 | - If var2 is less than or equal to zero : |
1453 | shr_r(var1,var2) = shr(var1,var2). |
1454 | |
1455 | Complexity weight : 2 |
1456 | |
1457 | Inputs : |
1458 | |
1459 | var1 |
1460 | 16 bit short signed integer (Word16) whose value falls in the |
1461 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
1462 | |
1463 | var2 |
1464 | 16 bit short signed integer (Word16) whose value falls in the |
1465 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
1466 | |
1467 | Outputs : |
1468 | |
1469 | none |
1470 | |
1471 | Return Value : |
1472 | |
1473 | var_out |
1474 | 16 bit short signed integer (Word16) whose value falls in the |
1475 | range : 0xffff 8000 <= var_out <= 0x0000 7fff. |
1476 |___________________________________________________________________________|
1477 */
1478
1479 Word16 shr_r (Word16 var1, Word16 var2)
1480 {
1481 Word16 var_out;
1482
1483 if (var2 > 15)
1484 {
1485 var_out = 0;
1486 }
1487 else
1488 {
1489 var_out = shr (var1, var2);
1490 #if (WMOPS)
1491 multiCounter[currCounter].shr--;
1492 #endif
1493
1494 if (var2 > 0)
1495 {
1496 if ((var1 & ((Word16) 1 << (var2 - 1))) != 0)
1497 {
1498 var_out++;
1499 }
1500 }
1501 }
1502 #if (WMOPS)
1503 multiCounter[currCounter].shr_r++;
1504 #endif
1505 return (var_out);
1506 }
1507
1508 /*___________________________________________________________________________
1509 | |
1510 | Function Name : mac_r |
1511 | |
1512 | Purpose : |
1513 | |
1514 | Multiply var1 by var2 and shift the result left by 1. Add the 32 bit |
1515 | result to L_var3 with saturation. Round the LS 16 bits of the result |
1516 | into the MS 16 bits with saturation and shift the result right by 16. |
1517 | Return a 16 bit result. |
1518 | mac_r(L_var3,var1,var2) = round(L_mac(L_var3,var1,var2)) |
1519 | |
1520 | Complexity weight : 2 |
1521 | |
1522 | Inputs : |
1523 | |
1524 | L_var3 32 bit long signed integer (Word32) whose value falls in the |
1525 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
1526 | |
1527 | var1 |
1528 | 16 bit short signed integer (Word16) whose value falls in the |
1529 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
1530 | |
1531 | var2 |
1532 | 16 bit short signed integer (Word16) whose value falls in the |
1533 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
1534 | |
1535 | Outputs : |
1536 | |
1537 | none |
1538 | |
1539 | Return Value : |
1540 | |
1541 | var_out |
1542 | 16 bit short signed integer (Word16) whose value falls in the |
1543 | range : 0x0000 8000 <= L_var_out <= 0x0000 7fff. |
1544 |___________________________________________________________________________|
1545 */
1546
1547 Word16 mac_r (Word32 L_var3, Word16 var1, Word16 var2)
1548 {
1549 Word16 var_out;
1550
1551 L_var3 = L_mac (L_var3, var1, var2);
1552 #if (WMOPS)
1553 multiCounter[currCounter].L_mac--;
1554 #endif
1555 L_var3 = L_add (L_var3, (Word32) 0x00008000L);
1556 #if (WMOPS)
1557 multiCounter[currCounter].L_add--;
1558 #endif
1559 var_out = extract_h (L_var3);
1560 #if (WMOPS)
1561 multiCounter[currCounter].extract_h--;
1562 multiCounter[currCounter].mac_r++;
1563 #endif
1564 return (var_out);
1565 }
1566
1567 /*___________________________________________________________________________
1568 | |
1569 | Function Name : msu_r |
1570 | |
1571 | Purpose : |
1572 | |
1573 | Multiply var1 by var2 and shift the result left by 1. Subtract the 32 |
1574 | bit result to L_var3 with saturation. Round the LS 16 bits of the res- |
1575 | ult into the MS 16 bits with saturation and shift the result right by |
1576 | 16. Return a 16 bit result. |
1577 | msu_r(L_var3,var1,var2) = round(L_msu(L_var3,var1,var2)) |
1578 | |
1579 | Complexity weight : 2 |
1580 | |
1581 | Inputs : |
1582 | |
1583 | L_var3 32 bit long signed integer (Word32) whose value falls in the |
1584 | range : 0x8000 0000 <= L_var3 <= 0x7fff ffff. |
1585 | |
1586 | var1 |
1587 | 16 bit short signed integer (Word16) whose value falls in the |
1588 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
1589 | |
1590 | var2 |
1591 | 16 bit short signed integer (Word16) whose value falls in the |
1592 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
1593 | |
1594 | Outputs : |
1595 | |
1596 | none |
1597 | |
1598 | Return Value : |
1599 | |
1600 | var_out |
1601 | 16 bit short signed integer (Word16) whose value falls in the |
1602 | range : 0x0000 8000 <= L_var_out <= 0x0000 7fff. |
1603 |___________________________________________________________________________|
1604 */
1605
1606 Word16 msu_r (Word32 L_var3, Word16 var1, Word16 var2)
1607 {
1608 Word16 var_out;
1609
1610 L_var3 = L_msu (L_var3, var1, var2);
1611 #if (WMOPS)
1612 multiCounter[currCounter].L_msu--;
1613 #endif
1614 L_var3 = L_add (L_var3, (Word32) 0x00008000L);
1615 #if (WMOPS)
1616 multiCounter[currCounter].L_add--;
1617 #endif
1618 var_out = extract_h (L_var3);
1619 #if (WMOPS)
1620 multiCounter[currCounter].extract_h--;
1621 multiCounter[currCounter].msu_r++;
1622 #endif
1623 return (var_out);
1624 }
1625
1626 /*___________________________________________________________________________
1627 | |
1628 | Function Name : L_deposit_h |
1629 | |
1630 | Purpose : |
1631 | |
1632 | Deposit the 16 bit var1 into the 16 MS bits of the 32 bit output. The |
1633 | 16 LS bits of the output are zeroed. |
1634 | |
1635 | Complexity weight : 2 |
1636 | |
1637 | Inputs : |
1638 | |
1639 | var1 |
1640 | 16 bit short signed integer (Word16) whose value falls in the |
1641 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
1642 | |
1643 | Outputs : |
1644 | |
1645 | none |
1646 | |
1647 | Return Value : |
1648 | |
1649 | L_var_out |
1650 | 32 bit long signed integer (Word32) whose value falls in the |
1651 | range : 0x8000 0000 <= var_out <= 0x7fff 0000. |
1652 |___________________________________________________________________________|
1653 */
1654
1655 Word32 L_deposit_h (Word16 var1)
1656 {
1657 Word32 L_var_out;
1658
1659 L_var_out = (Word32) var1 << 16;
1660 #if (WMOPS)
1661 multiCounter[currCounter].L_deposit_h++;
1662 #endif
1663 return (L_var_out);
1664 }
1665
1666 /*___________________________________________________________________________
1667 | |
1668 | Function Name : L_deposit_l |
1669 | |
1670 | Purpose : |
1671 | |
1672 | Deposit the 16 bit var1 into the 16 LS bits of the 32 bit output. The |
1673 | 16 MS bits of the output are sign extended. |
1674 | |
1675 | Complexity weight : 2 |
1676 | |
1677 | Inputs : |
1678 | |
1679 | var1 |
1680 | 16 bit short signed integer (Word16) whose value falls in the |
1681 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
1682 | |
1683 | Outputs : |
1684 | |
1685 | none |
1686 | |
1687 | Return Value : |
1688 | |
1689 | L_var_out |
1690 | 32 bit long signed integer (Word32) whose value falls in the |
1691 | range : 0xFFFF 8000 <= var_out <= 0x0000 7fff. |
1692 |___________________________________________________________________________|
1693 */
1694
1695 Word32 L_deposit_l (Word16 var1)
1696 {
1697 Word32 L_var_out;
1698
1699 L_var_out = (Word32) var1;
1700 #if (WMOPS)
1701 multiCounter[currCounter].L_deposit_l++;
1702 #endif
1703 return (L_var_out);
1704 }
1705
1706 /*___________________________________________________________________________
1707 | |
1708 | Function Name : L_shr_r |
1709 | |
1710 | Purpose : |
1711 | |
1712 | Same as L_shr(L_var1,var2) but with rounding. Saturate the result in |
1713 | case of underflows or overflows : |
1714 | - If var2 is greater than zero : |
1715 | if (L_sub(L_shl(L_shr(L_var1,var2),1),L_shr(L_var1,sub(var2,1))))|
1716 | is equal to zero |
1717 | then |
1718 | L_shr_r(L_var1,var2) = L_shr(L_var1,var2) |
1719 | else |
1720 | L_shr_r(L_var1,var2) = L_add(L_shr(L_var1,var2),1) |
1721 | - If var2 is less than or equal to zero : |
1722 | L_shr_r(L_var1,var2) = L_shr(L_var1,var2). |
1723 | |
1724 | Complexity weight : 3 |
1725 | |
1726 | Inputs : |
1727 | |
1728 | L_var1 |
1729 | 32 bit long signed integer (Word32) whose value falls in the |
1730 | range : 0x8000 0000 <= var1 <= 0x7fff ffff. |
1731 | |
1732 | var2 |
1733 | 16 bit short signed integer (Word16) whose value falls in the |
1734 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
1735 | |
1736 | Outputs : |
1737 | |
1738 | none |
1739 | |
1740 | Return Value : |
1741 | |
1742 | L_var_out |
1743 | 32 bit long signed integer (Word32) whose value falls in the |
1744 | range : 0x8000 0000 <= var_out <= 0x7fff ffff. |
1745 |___________________________________________________________________________|
1746 */
1747
1748 Word32 L_shr_r (Word32 L_var1, Word16 var2)
1749 {
1750 Word32 L_var_out;
1751
1752 if (var2 > 31)
1753 {
1754 L_var_out = 0;
1755 }
1756 else
1757 {
1758 L_var_out = L_shr (L_var1, var2);
1759 #if (WMOPS)
1760 multiCounter[currCounter].L_shr--;
1761 #endif
1762 if (var2 > 0)
1763 {
1764 if ((L_var1 & ((Word32) 1 << (var2 - 1))) != 0)
1765 {
1766 L_var_out++;
1767 }
1768 }
1769 }
1770 #if (WMOPS)
1771 multiCounter[currCounter].L_shr_r++;
1772 #endif
1773 return (L_var_out);
1774 }
1775
1776 /*___________________________________________________________________________
1777 | |
1778 | Function Name : L_abs |
1779 | |
1780 | Purpose : |
1781 | |
1782 | Absolute value of L_var1; Saturate in case where the input is |
1783 | -214783648 |
1784 | |
1785 | Complexity weight : 3 |
1786 | |
1787 | Inputs : |
1788 | |
1789 | L_var1 |
1790 | 32 bit long signed integer (Word32) whose value falls in the |
1791 | range : 0x8000 0000 <= var1 <= 0x7fff ffff. |
1792 | |
1793 | Outputs : |
1794 | |
1795 | none |
1796 | |
1797 | Return Value : |
1798 | |
1799 | L_var_out |
1800 | 32 bit long signed integer (Word32) whose value falls in the |
1801 | range : 0x0000 0000 <= var_out <= 0x7fff ffff. |
1802 |___________________________________________________________________________|
1803 */
1804
1805 Word32 L_abs (Word32 L_var1)
1806 {
1807 Word32 L_var_out;
1808
1809 if (L_var1 == MIN_32)
1810 {
1811 L_var_out = MAX_32;
1812 }
1813 else
1814 {
1815 if (L_var1 < 0)
1816 {
1817 L_var_out = -L_var1;
1818 }
1819 else
1820 {
1821 L_var_out = L_var1;
1822 }
1823 }
1824
1825 #if (WMOPS)
1826 multiCounter[currCounter].L_abs++;
1827 #endif
1828 return (L_var_out);
1829 }
1830
1831 /*___________________________________________________________________________
1832 | |
1833 | Function Name : L_sat |
1834 | |
1835 | Purpose : |
1836 | |
1837 | 32 bit L_var1 is set to 2147483647 if an overflow occured or to |
1838 | -2147483648 if an underflow occured on the most recent L_add_c, |
1839 | L_sub_c, L_macNs or L_msuNs operations. The carry and overflow values |
1840 | are binary values which can be tested and assigned values. |
1841 | |
1842 | Complexity weight : 4 |
1843 | |
1844 | Inputs : |
1845 | |
1846 | L_var1 |
1847 | 32 bit long signed integer (Word32) whose value falls in the |
1848 | range : 0x8000 0000 <= var1 <= 0x7fff ffff. |
1849 | |
1850 | Outputs : |
1851 | |
1852 | none |
1853 | |
1854 | Return Value : |
1855 | |
1856 | L_var_out |
1857 | 32 bit long signed integer (Word32) whose value falls in the |
1858 | range : 0x8000 0000 <= var_out <= 0x7fff ffff. |
1859 |___________________________________________________________________________|
1860 */
1861
1862 Word32 L_sat (Word32 L_var1)
1863 {
1864 Word32 L_var_out;
1865
1866 L_var_out = L_var1;
1867
1868 if (Overflow)
1869 {
1870
1871 if (Carry)
1872 {
1873 L_var_out = MIN_32;
1874 }
1875 else
1876 {
1877 L_var_out = MAX_32;
1878 }
1879
1880 Carry = 0;
1881 Overflow = 0;
1882 }
1883 #if (WMOPS)
1884 multiCounter[currCounter].L_sat++;
1885 #endif
1886 return (L_var_out);
1887 }
1888
1889 /*___________________________________________________________________________
1890 | |
1891 | Function Name : norm_s |
1892 | |
1893 | Purpose : |
1894 | |
1895 | Produces the number of left shift needed to normalize the 16 bit varia- |
1896 | ble var1 for positive values on the interval with minimum of 16384 and |
1897 | maximum of 32767, and for negative values on the interval with minimum |
1898 | of -32768 and maximum of -16384; in order to normalize the result, the |
1899 | following operation must be done : |
1900 | norm_var1 = shl(var1,norm_s(var1)). |
1901 | |
1902 | Complexity weight : 15 |
1903 | |
1904 | Inputs : |
1905 | |
1906 | var1 |
1907 | 16 bit short signed integer (Word16) whose value falls in the |
1908 | range : 0xffff 8000 <= var1 <= 0x0000 7fff. |
1909 | |
1910 | Outputs : |
1911 | |
1912 | none |
1913 | |
1914 | Return Value : |
1915 | |
1916 | var_out |
1917 | 16 bit short signed integer (Word16) whose value falls in the |
1918 | range : 0x0000 0000 <= var_out <= 0x0000 000f. |
1919 |___________________________________________________________________________|
1920 */
1921
1922 Word16 norm_s (Word16 var1)
1923 {
1924 Word16 var_out;
1925
1926 if (var1 == 0)
1927 {
1928 var_out = 0;
1929 }
1930 else
1931 {
1932 if (var1 == (Word16) 0xffff)
1933 {
1934 var_out = 15;
1935 }
1936 else
1937 {
1938 if (var1 < 0)
1939 {
1940 var1 = ~var1;
1941 }
1942 for (var_out = 0; var1 < 0x4000; var_out++)
1943 {
1944 var1 <<= 1;
1945 }
1946 }
1947 }
1948
1949 #if (WMOPS)
1950 multiCounter[currCounter].norm_s++;
1951 #endif
1952 return (var_out);
1953 }
1954
1955 /*___________________________________________________________________________
1956 | |
1957 | Function Name : div_s |
1958 | |
1959 | Purpose : |
1960 | |
1961 | Produces a result which is the fractional integer division of var1 by |
1962 | var2; var1 and var2 must be positive and var2 must be greater or equal |
1963 | to var1; the result is positive (leading bit equal to 0) and truncated |
1964 | to 16 bits. |
1965 | If var1 = var2 then div(var1,var2) = 32767. |
1966 | |
1967 | Complexity weight : 18 |
1968 | |
1969 | Inputs : |
1970 | |
1971 | var1 |
1972 | 16 bit short signed integer (Word16) whose value falls in the |
1973 | range : 0x0000 0000 <= var1 <= var2 and var2 != 0. |
1974 | |
1975 | var2 |
1976 | 16 bit short signed integer (Word16) whose value falls in the |
1977 | range : var1 <= var2 <= 0x0000 7fff and var2 != 0. |
1978 | |
1979 | Outputs : |
1980 | |
1981 | none |
1982 | |
1983 | Return Value : |
1984 | |
1985 | var_out |
1986 | 16 bit short signed integer (Word16) whose value falls in the |
1987 | range : 0x0000 0000 <= var_out <= 0x0000 7fff. |
1988 | It's a Q15 value (point between b15 and b14). |
1989 |___________________________________________________________________________|
1990 */
1991
1992 Word16 div_s (Word16 var1, Word16 var2)
1993 {
1994 Word16 var_out = 0;
1995 Word16 iteration;
1996 Word32 L_num;
1997 Word32 L_denom;
1998
1999 #if 0
2000 if ((var1 > var2) || (var1 < 0) || (var2 < 0))
2001 {
2002 printf ("Division Error var1=%d var2=%d\n", var1, var2);
2003 abort(); /* exit (0); */
2004 }
2005 if (var2 == 0)
2006 {
2007 printf ("Division by 0, Fatal error \n");
2008 abort(); /* exit (0); */
2009 }
2010 #endif
2011 if (var1 == 0)
2012 {
2013 var_out = 0;
2014 }
2015 else
2016 {
2017 if (var1 == var2)
2018 {
2019 var_out = MAX_16;
2020 }
2021 else
2022 {
2023 L_num = L_deposit_l (var1);
2024 #if (WMOPS)
2025 multiCounter[currCounter].L_deposit_l--;
2026 #endif
2027 L_denom = L_deposit_l (var2);
2028 #if (WMOPS)
2029 multiCounter[currCounter].L_deposit_l--;
2030 #endif
2031
2032 for (iteration = 0; iteration < 15; iteration++)
2033 {
2034 var_out <<= 1;
2035 L_num <<= 1;
2036
2037 if (L_num >= L_denom)
2038 {
2039 L_num = L_sub (L_num, L_denom);
2040 #if (WMOPS)
2041 multiCounter[currCounter].L_sub--;
2042 #endif
2043 var_out = add (var_out, 1);
2044 #if (WMOPS)
2045 multiCounter[currCounter].add--;
2046 #endif
2047 }
2048 }
2049 }
2050 }
2051
2052 #if (WMOPS)
2053 multiCounter[currCounter].div_s++;
2054 #endif
2055 return (var_out);
2056 }
2057
2058 /*___________________________________________________________________________
2059 | |
2060 | Function Name : norm_l |
2061 | |
2062 | Purpose : |
2063 | |
2064 | Produces the number of left shifts needed to normalize the 32 bit varia-|
2065 | ble L_var1 for positive values on the interval with minimum of |
2066 | 1073741824 and maximum of 2147483647, and for negative values on the in-|
2067 | terval with minimum of -2147483648 and maximum of -1073741824; in order |
2068 | to normalize the result, the following operation must be done : |
2069 | norm_L_var1 = L_shl(L_var1,norm_l(L_var1)). |
2070 | |
2071 | Complexity weight : 30 |
2072 | |
2073 | Inputs : |
2074 | |
2075 | L_var1 |
2076 | 32 bit long signed integer (Word32) whose value falls in the |
2077 | range : 0x8000 0000 <= var1 <= 0x7fff ffff. |
2078 | |
2079 | Outputs : |
2080 | |
2081 | none |
2082 | |
2083 | Return Value : |
2084 | |
2085 | var_out |
2086 | 16 bit short signed integer (Word16) whose value falls in the |
2087 | range : 0x0000 0000 <= var_out <= 0x0000 001f. |
2088 |___________________________________________________________________________|
2089 */
2090
2091 Word16 norm_l (Word32 L_var1)
2092 {
2093 Word16 var_out;
2094
2095 if (L_var1 == 0)
2096 {
2097 var_out = 0;
2098 }
2099 else
2100 {
2101 if (L_var1 == (Word32) 0xffffffffL)
2102 {
2103 var_out = 31;
2104 }
2105 else
2106 {
2107 if (L_var1 < 0)
2108 {
2109 L_var1 = ~L_var1;
2110 }
2111 for (var_out = 0; L_var1 < (Word32) 0x40000000L; var_out++)
2112 {
2113 L_var1 <<= 1;
2114 }
2115 }
2116 }
2117
2118 #if (WMOPS)
2119 multiCounter[currCounter].norm_l++;
2120 #endif
2121 return (var_out);
2122 }