mathhalf.h
上传用户:csczyc
上传日期:2021-02-19
资源大小:1051k
文件大小:7k
源码类别:

语音压缩

开发平台:

C/C++

  1. /*
  2. 2.4 kbps MELP Proposed Federal Standard speech coder
  3. Fixed-point C code, version 1.0
  4. Copyright (c) 1998, Texas Instruments, Inc.  
  5. Texas Instruments has intellectual property rights on the MELP
  6. algorithm.  The Texas Instruments contact for licensing issues for
  7. commercial and non-government use is William Gordon, Director,
  8. Government Contracts, Texas Instruments Incorporated, Semiconductor
  9. Group (phone 972 480 7442).
  10. The fixed-point version of the voice codec Mixed Excitation Linear
  11. Prediction (MELP) is based on specifications on the C-language software
  12. simulation contained in GSM 06.06 which is protected by copyright and
  13. is the property of the European Telecommunications Standards Institute
  14. (ETSI). This standard is available from the ETSI publication office
  15. tel. +33 (0)4 92 94 42 58. ETSI has granted a license to United States
  16. Department of Defense to use the C-language software simulation contained
  17. in GSM 06.06 for the purposes of the development of a fixed-point
  18. version of the voice codec Mixed Excitation Linear Prediction (MELP).
  19. Requests for authorization to make other use of the GSM 06.06 or
  20. otherwise distribute or modify them need to be addressed to the ETSI
  21. Secretariat fax: +33 493 65 47 16.
  22. */
  23. #include "typedefs.h"
  24. #ifndef __MATHHALF
  25. #define __MATHHALF
  26. /* addition */
  27. /************/
  28. Shortword add(Shortword var1, Shortword var2);  /* 1 ops */
  29. /* Shortword sub(Shortword var1, Shortword var2);   1 ops */
  30. Longword L_add(Longword L_var1, Longword L_var2);       /* 2 ops */
  31. Longword L_sub(Longword L_var1, Longword L_var2);       /* 2 ops */
  32. __inline Shortword sub(Shortword var1, Shortword var2) /* 1 ops */
  33. {
  34.   Longword L_diff;
  35.   Shortword swOut;
  36.   extern int saturation;
  37.   L_diff = (Longword) var1 - var2;
  38.    if (L_diff > SW_MAX) {
  39.     swOut = SW_MAX;
  40.     saturation = saturation + 1;
  41.   }
  42.   else if (L_diff < SW_MIN) {
  43.     swOut = SW_MIN;
  44.     saturation = saturation + 1;
  45.   }
  46.   else {
  47.       swOut = (Shortword) L_diff;        /* automatic type conversion */
  48.   } 
  49.   return (swOut);
  50. }
  51. /* multiplication */
  52. /******************/
  53. Shortword mult(Shortword var1, Shortword var2); /* 1 ops */
  54. Longword L_mult(Shortword var1, Shortword var2);        /* 1 ops */
  55. Shortword mult_r(Shortword var1, Shortword var2);       /* 2 ops */
  56. /* arithmetic shifts */
  57. /*********************/
  58. Shortword shr(Shortword var1, Shortword var2);  /* 1 ops */
  59. Shortword shl(Shortword var1, Shortword var2);  /* 1 ops */
  60. Longword L_shr(Longword L_var1, Shortword var2);        /* 2 ops */
  61. Longword L_shl(Longword L_var1, Shortword var2);        /* 2 ops */
  62. Shortword shift_r(Shortword var, Shortword var2);       /* 2 ops */
  63. Longword L_shift_r(Longword L_var, Shortword var2);     /* 3 ops */
  64. __inline Shortword shl_a(Shortword var1, Shortword var2)
  65. {
  66.   Shortword swOut;
  67.   Longword L_Out;
  68. //  extern int complexity;mark del
  69.   extern int saturation; 
  70. //  int old_complexity;mark del
  71.   
  72. //  old_complexity = complexity;mark del
  73.   if (var2 == 0 || var1 == 0) {
  74.     swOut = var1;
  75.   }
  76.   else {
  77.     /* var2 > 0 */
  78.     if (var2 >= 15) {
  79.       swOut = (var1 > 0) ? SW_MAX : SW_MIN;     /* saturate */
  80.       saturation = saturation + 1;
  81.     }
  82.     else {
  83.       L_Out = (Longword) var1 *(1 << var2);
  84.       swOut = (Shortword) L_Out;       /* copy low portion to swOut,
  85.                                         * overflow could have hpnd */
  86.       if (swOut != L_Out) {
  87.         /* overflow  */
  88.         swOut = (var1 > 0) ? SW_MAX : SW_MIN;   /* saturate */
  89. saturation = saturation + 1;
  90.       }
  91.     }
  92.   }
  93. //  complexity = old_complexity + 1;mark del
  94.   return (swOut);
  95. }
  96. __inline Shortword shr_a(Shortword var1, Shortword var2)
  97. {
  98.   Shortword swMask,
  99.          swOut;
  100. //  extern int complexity;mark del
  101.   extern int saturation;
  102. //  int old_complexity;mark del
  103.   
  104. //  old_complexity = complexity;mark del
  105.   if (var2 == 0 || var1 == 0)
  106.     swOut = var1;
  107.   else {
  108.     /* positive shift count */
  109.     /*----------------------*/
  110.     if (var2 >= 15)
  111.       swOut = (var1 < 0) ? (Shortword) 0xffff : 0x0;
  112.     else {
  113.       /* take care of sign extension */
  114.       /*-----------------------------*/
  115.       swMask = 0;
  116.       if (var1 < 0) {
  117.         swMask = ~swMask << (16 - var2);
  118.       }
  119.       var1 >>= var2;
  120.       swOut = swMask | var1;
  121.     }
  122.   }
  123.  // complexity = old_complexity + 1;mark del
  124.   return (swOut);
  125. }
  126. /* absolute value  */
  127. /*******************/
  128. Shortword abs_s(Shortword var1);       /* 1 ops */
  129. Longword L_abs(Longword var1);         /* 3 ops */
  130. /* multiply accumulate  */
  131. /************************/
  132. Longword L_mac(Longword L_var3,
  133.                       Shortword var1, Shortword var2);  /* 1 op */
  134. Shortword mac_r(Longword L_var3,
  135.                        Shortword var1, Shortword var2); /* 2 op */
  136. Longword L_msu(Longword L_var3,
  137.                       Shortword var1, Shortword var2);  /* 1 op */
  138. Shortword msu_r(Longword L_var3,
  139.                        Shortword var1, Shortword var2); /* 2 op */
  140. /* negation  */
  141. /*************/
  142. /* Shortword negate(Shortword var1);      1 ops */ 
  143. Longword L_negate(Longword L_var1);    /* 2 ops */
  144. __inline Shortword negate(Shortword var1)
  145. {
  146.   Shortword swOut;
  147.  // extern int complexity;mark del
  148.   extern int saturation;
  149.  // int old_complexity;mark del
  150.   
  151. //  old_complexity = complexity;mark del
  152.   if (var1 == SW_MIN) {
  153.       saturation = saturation + 1; 
  154.       swOut = SW_MAX;
  155.   }
  156.   else {
  157.       swOut = -var1;
  158.   }
  159. //  complexity = old_complexity + 1;mark del
  160.   return (swOut);
  161. }
  162. /* Accumulator manipulation */
  163. /****************************/
  164. Longword L_deposit_l(Shortword var1);  /* 1 ops */
  165. Longword L_deposit_h(Shortword var1);  /* 1 ops */
  166. Shortword extract_l(Longword L_var1);  /* 1 ops */
  167. Shortword extract_h(Longword L_var1);  /* 1 ops */
  168. /* Round */
  169. /*********/
  170. Shortword round(Longword L_var1);      /* 1 ops */
  171. /* Normalization */
  172. /*****************/
  173. Shortword norm_l(Longword L_var1);     /* 30 ops */
  174. Shortword norm_s(Shortword var1);      /* 15 ops */
  175. /* Division */
  176. /************/
  177. /* Shortword divide_s(Shortword var1, Shortword var2);      18 ops */ 
  178. __inline Shortword divide_s(Shortword var1, Shortword var2)
  179. {
  180.   Longword L_div;
  181.   Shortword swOut;
  182.   extern int saturation;
  183. //  extern int complexity;mark del
  184. //  int old_complexity;mark del
  185.   
  186. //  old_complexity = complexity;Longword 
  187.   if (var1 < 0 || var2 < 0 || var1 > var2) {
  188.     /* undefined output for invalid input into divide_s */
  189.     return ((Shortword)0);
  190.   }
  191.   if (var1 == var2)
  192.     return ((Shortword)0x7fff);
  193.   L_div = ((0x00008000L * (Longword) var1) / (Longword) var2);
  194.   
  195.  /* swOut = saturate(L_div); */
  196.   if (L_div> SW_MAX) {
  197.     swOut = SW_MAX;
  198.     saturation = saturation + 1;
  199.   }
  200.   else if (L_div< SW_MIN) {
  201.     swOut = SW_MIN;
  202.     saturation = saturation + 1;
  203.   }
  204.   else {
  205.       swOut = (Shortword) L_div;        /* automatic type conversion */
  206.   }
  207. //  complexity = old_complexity + 18;mark del
  208.   return (swOut);
  209. }
  210. /* Non-saturating instructions */
  211. /*******************************/
  212. Longword L_add_c(Longword L_Var1, Longword L_Var2);     /* 2 ops */
  213. Longword L_sub_c(Longword L_Var1, Longword L_Var2);     /* 2 ops */
  214. Longword L_sat(Longword L_var1);       /* 4 ops */
  215. Longword L_macNs(Longword L_var3,
  216.                         Shortword var1, Shortword var2);        /* 1 ops */
  217. Longword L_msuNs(Longword L_var3,
  218.                         Shortword var1, Shortword var2);        /* 1 ops */
  219. #endif