Category

Development Platform
Home > SourceCode/Document > Communication-Mobile > Voice Compress > View Code
GSM_IMPL.C
Package: GSM.rar　[view]
Upload User: tianfasz
Upload Date: 2008-11-09
Package Size: 80k
Code Size: 11k
Category:

Voice Compress

Development Platform:

C/C++

GSM_IMPL.C：Code Content
  2. #include "private.h"
  4. #include "gsm.h"
  5. #include "proto.h"
  7. void gsm_implode P3((s, source, c), gsm s, gsm_signal * source, gsm_byte * c)
  8. {
  9. # define LARc source
  10. # define Nc *((gsm_signal (*) [17])(source + 8))
  11. # define bc *((gsm_signal (*) [17])(source + 9))
  12. # define Mc *((gsm_signal (*) [17])(source + 10))
  13. # define xmaxc *((gsm_signal (*) [17])(source + 11))
  15. #ifdef WAV49
  16. if (s->wav_fmt) {
  18. uword sr = 0;
  19. if (s->frame_index == 0) {
  21. sr = *c++;
  22. LARc[0] = sr & 0x3f;  sr >>= 6;
  23. sr |= (uword)*c++ << 2;
  24. LARc[1] = sr & 0x3f;  sr >>= 6;
  25. sr |= (uword)*c++ << 4;
  26. LARc[2] = sr & 0x1f;  sr >>= 5;
  27. LARc[3] = sr & 0x1f;  sr >>= 5;
  28. sr |= (uword)*c++ << 2;
  29. LARc[4] = sr & 0xf;  sr >>= 4;
  30. LARc[5] = sr & 0xf;  sr >>= 4;
  31. sr |= (uword)*c++ << 2; /* 5 */
  32. LARc[6] = sr & 0x7;  sr >>= 3;
  33. LARc[7] = sr & 0x7;  sr >>= 3;
  34. sr |= (uword)*c++ << 4;
  35. Nc[0] = sr & 0x7f;  sr >>= 7;
  36. bc[0] = sr & 0x3;  sr >>= 2;
  37. Mc[0] = sr & 0x3;  sr >>= 2;
  38. sr |= (uword)*c++ << 1;
  39. xmaxc[0] = sr & 0x3f;  sr >>= 6;
  40. #undef xmc
  41. #define xmc (source + 12)
  42. xmc[0] = sr & 0x7;  sr >>= 3;
  43. sr = *c++;
  44. xmc[1] = sr & 0x7;  sr >>= 3;
  45. xmc[2] = sr & 0x7;  sr >>= 3;
  46. sr |= (uword)*c++ << 2;
  47. xmc[3] = sr & 0x7;  sr >>= 3;
  48. xmc[4] = sr & 0x7;  sr >>= 3;
  49. xmc[5] = sr & 0x7;  sr >>= 3;
  50. sr |= (uword)*c++ << 1; /* 10 */
  51. xmc[6] = sr & 0x7;  sr >>= 3;
  52. xmc[7] = sr & 0x7;  sr >>= 3;
  53. xmc[8] = sr & 0x7;  sr >>= 3;
  54. sr = *c++;
  55. xmc[9] = sr & 0x7;  sr >>= 3;
  56. xmc[10] = sr & 0x7;  sr >>= 3;
  57. sr |= (uword)*c++ << 2;
  58. xmc[11] = sr & 0x7;  sr >>= 3;
  59. xmc[12] = sr & 0x7;  sr >>= 3;
  60. sr |= (uword)*c++ << 4;
  61. Nc[1] = sr & 0x7f;  sr >>= 7;
  62. bc[1] = sr & 0x3;  sr >>= 2;
  63. Mc[1] = sr & 0x3;  sr >>= 2;
  64. sr |= (uword)*c++ << 1;
  65. xmaxc[1] = sr & 0x3f;  sr >>= 6;
  66. #undef xmc
  67. #define xmc (source + 29 - 13)
  68. xmc[13] = sr & 0x7;  sr >>= 3;
  69. sr = *c++; /* 15 */
  70. xmc[14] = sr & 0x7;  sr >>= 3;
  71. xmc[15] = sr & 0x7;  sr >>= 3;
  72. sr |= (uword)*c++ << 2;
  73. xmc[16] = sr & 0x7;  sr >>= 3;
  74. xmc[17] = sr & 0x7;  sr >>= 3;
  75. xmc[18] = sr & 0x7;  sr >>= 3;
  76. sr |= (uword)*c++ << 1;
  77. xmc[19] = sr & 0x7;  sr >>= 3;
  78. xmc[20] = sr & 0x7;  sr >>= 3;
  79. xmc[21] = sr & 0x7;  sr >>= 3;
  80. sr = *c++;
  81. xmc[22] = sr & 0x7;  sr >>= 3;
  82. xmc[23] = sr & 0x7;  sr >>= 3;
  83. sr |= (uword)*c++ << 2;
  84. xmc[24] = sr & 0x7;  sr >>= 3;
  85. xmc[25] = sr & 0x7;  sr >>= 3;
  86. sr |= (uword)*c++ << 4; /* 20 */
  87. Nc[2] = sr & 0x7f;  sr >>= 7;
  88. bc[2] = sr & 0x3;  sr >>= 2;
  89. Mc[2] = sr & 0x3;  sr >>= 2;
  90. sr |= (uword)*c++ << 1;
  91. xmaxc[2] = sr & 0x3f;  sr >>= 6;
  92. #undef xmc
  93. #define xmc (source + 46 - 26)
  94. xmc[26] = sr & 0x7;  sr >>= 3;
  95. sr = *c++;
  96. xmc[27] = sr & 0x7;  sr >>= 3;
  97. xmc[28] = sr & 0x7;  sr >>= 3;
  98. sr |= (uword)*c++ << 2;
  99. xmc[29] = sr & 0x7;  sr >>= 3;
  100. xmc[30] = sr & 0x7;  sr >>= 3;
  101. xmc[31] = sr & 0x7;  sr >>= 3;
  102. sr |= (uword)*c++ << 1;
  103. xmc[32] = sr & 0x7;  sr >>= 3;
  104. xmc[33] = sr & 0x7;  sr >>= 3;
  105. xmc[34] = sr & 0x7;  sr >>= 3;
  106. sr = *c++; /* 25 */
  107. xmc[35] = sr & 0x7;  sr >>= 3;
  108. xmc[36] = sr & 0x7;  sr >>= 3;
  109. sr |= (uword)*c++ << 2;
  110. xmc[37] = sr & 0x7;  sr >>= 3;
  111. xmc[38] = sr & 0x7;  sr >>= 3;
  112. sr |= (uword)*c++ << 4;
  113. Nc[3] = sr & 0x7f;  sr >>= 7;
  114. bc[3] = sr & 0x3;  sr >>= 2;
  115. Mc[3] = sr & 0x3;  sr >>= 2;
  116. sr |= (uword)*c++ << 1;
  117. xmaxc[3] = sr & 0x3f;  sr >>= 6;
  118. #undef xmc
  119. #define xmc (source + 63 - 39)
  121. xmc[39] = sr & 0x7;  sr >>= 3;
  122. sr = *c++;
  123. xmc[40] = sr & 0x7;  sr >>= 3;
  124. xmc[41] = sr & 0x7;  sr >>= 3;
  125. sr |= (uword)*c++ << 2; /* 30 */
  126. xmc[42] = sr & 0x7;  sr >>= 3;
  127. xmc[43] = sr & 0x7;  sr >>= 3;
  128. xmc[44] = sr & 0x7;  sr >>= 3;
  129. sr |= (uword)*c++ << 1;
  130. xmc[45] = sr & 0x7;  sr >>= 3;
  131. xmc[46] = sr & 0x7;  sr >>= 3;
  132. xmc[47] = sr & 0x7;  sr >>= 3;
  133. sr = *c++;
  134. xmc[48] = sr & 0x7;  sr >>= 3;
  135. xmc[49] = sr & 0x7;  sr >>= 3;
  136. sr |= (uword)*c++ << 2;
  137. xmc[50] = sr & 0x7;  sr >>= 3;
  138. xmc[51] = sr & 0x7;  sr >>= 3;
  140. s->frame_chain = sr & 0xf;
  141. }
  142. else {
  143. sr = s->frame_chain;
  144. sr |= (uword)*c++ << 4; /* 1 */
  145. LARc[0] = sr & 0x3f;  sr >>= 6;
  146. LARc[1] = sr & 0x3f;  sr >>= 6;
  147. sr = *c++;
  148. LARc[2] = sr & 0x1f;  sr >>= 5;
  149. sr |= (uword)*c++ << 3;
  150. LARc[3] = sr & 0x1f;  sr >>= 5;
  151. LARc[4] = sr & 0xf;  sr >>= 4;
  152. sr |= (uword)*c++ << 2;
  153. LARc[5] = sr & 0xf;  sr >>= 4;
  154. LARc[6] = sr & 0x7;  sr >>= 3;
  155. LARc[7] = sr & 0x7;  sr >>= 3;
  156. sr = *c++; /* 5 */
  157. Nc[0] = sr & 0x7f;  sr >>= 7;
  158. sr |= (uword)*c++ << 1;
  159. bc[0] = sr & 0x3;  sr >>= 2;
  160. Mc[0] = sr & 0x3;  sr >>= 2;
  161. sr |= (uword)*c++ << 5;
  162. xmaxc[0] = sr & 0x3f;  sr >>= 6;
  163. #undef xmc
  164. #define xmc (source + 12)
  165. xmc[0] = sr & 0x7;  sr >>= 3;
  166. xmc[1] = sr & 0x7;  sr >>= 3;
  167. sr |= (uword)*c++ << 1;
  168. xmc[2] = sr & 0x7;  sr >>= 3;
  169. xmc[3] = sr & 0x7;  sr >>= 3;
  170. xmc[4] = sr & 0x7;  sr >>= 3;
  171. sr = *c++;
  172. xmc[5] = sr & 0x7;  sr >>= 3;
  173. xmc[6] = sr & 0x7;  sr >>= 3;
  174. sr |= (uword)*c++ << 2; /* 10 */
  175. xmc[7] = sr & 0x7;  sr >>= 3;
  176. xmc[8] = sr & 0x7;  sr >>= 3;
  177. xmc[9] = sr & 0x7;  sr >>= 3;
  178. sr |= (uword)*c++ << 1;
  179. xmc[10] = sr & 0x7;  sr >>= 3;
  180. xmc[11] = sr & 0x7;  sr >>= 3;
  181. xmc[12] = sr & 0x7;  sr >>= 3;
  182. sr = *c++;
  183. Nc[1] = sr & 0x7f;  sr >>= 7;
  184. sr |= (uword)*c++ << 1;
  185. bc[1] = sr & 0x3;  sr >>= 2;
  186. Mc[1] = sr & 0x3;  sr >>= 2;
  187. sr |= (uword)*c++ << 5;
  188. xmaxc[1] = sr & 0x3f;  sr >>= 6;
  189. #undef xmc
  190. #define xmc (source + 29 - 13)
  191. xmc[13] = sr & 0x7;  sr >>= 3;
  192. xmc[14] = sr & 0x7;  sr >>= 3;
  193. sr |= (uword)*c++ << 1; /* 15 */
  194. xmc[15] = sr & 0x7;  sr >>= 3;
  195. xmc[16] = sr & 0x7;  sr >>= 3;
  196. xmc[17] = sr & 0x7;  sr >>= 3;
  197. sr = *c++;
  198. xmc[18] = sr & 0x7;  sr >>= 3;
  199. xmc[19] = sr & 0x7;  sr >>= 3;
  200. sr |= (uword)*c++ << 2;
  201. xmc[20] = sr & 0x7;  sr >>= 3;
  202. xmc[21] = sr & 0x7;  sr >>= 3;
  203. xmc[22] = sr & 0x7;  sr >>= 3;
  204. sr |= (uword)*c++ << 1;
  205. xmc[23] = sr & 0x7;  sr >>= 3;
  206. xmc[24] = sr & 0x7;  sr >>= 3;
  207. xmc[25] = sr & 0x7;  sr >>= 3;
  208. sr = *c++;
  209. Nc[2] = sr & 0x7f;  sr >>= 7;
  210. sr |= (uword)*c++ << 1; /* 20 */
  211. bc[2] = sr & 0x3;  sr >>= 2;
  212. Mc[2] = sr & 0x3;  sr >>= 2;
  213. sr |= (uword)*c++ << 5;
  214. xmaxc[2] = sr & 0x3f;  sr >>= 6;
  215. #undef xmc
  216. #define xmc (source + 46 - 26)
  217. xmc[26] = sr & 0x7;  sr >>= 3;
  218. xmc[27] = sr & 0x7;  sr >>= 3;
  219. sr |= (uword)*c++ << 1;
  220. xmc[28] = sr & 0x7;  sr >>= 3;
  221. xmc[29] = sr & 0x7;  sr >>= 3;
  222. xmc[30] = sr & 0x7;  sr >>= 3;
  223. sr = *c++;
  224. xmc[31] = sr & 0x7;  sr >>= 3;
  225. xmc[32] = sr & 0x7;  sr >>= 3;
  226. sr |= (uword)*c++ << 2;
  227. xmc[33] = sr & 0x7;  sr >>= 3;
  228. xmc[34] = sr & 0x7;  sr >>= 3;
  229. xmc[35] = sr & 0x7;  sr >>= 3;
  230. sr |= (uword)*c++ << 1; /* 25 */
  231. xmc[36] = sr & 0x7;  sr >>= 3;
  232. xmc[37] = sr & 0x7;  sr >>= 3;
  233. xmc[38] = sr & 0x7;  sr >>= 3;
  234. sr = *c++;
  235. Nc[3] = sr & 0x7f;  sr >>= 7;
  236. sr |= (uword)*c++ << 1;
  237. bc[3] = sr & 0x3;  sr >>= 2;
  238. Mc[3] = sr & 0x3;  sr >>= 2;
  239. sr |= (uword)*c++ << 5;
  240. xmaxc[3] = sr & 0x3f;  sr >>= 6;
  241. #undef xmc
  242. #define xmc (source + 63 - 39)
  244. xmc[39] = sr & 0x7;  sr >>= 3;
  245. xmc[40] = sr & 0x7;  sr >>= 3;
  246. sr |= (uword)*c++ << 1;
  247. xmc[41] = sr & 0x7;  sr >>= 3;
  248. xmc[42] = sr & 0x7;  sr >>= 3;
  249. xmc[43] = sr & 0x7;  sr >>= 3;
  250. sr = *c++; /* 30 */
  251. xmc[44] = sr & 0x7;  sr >>= 3;
  252. xmc[45] = sr & 0x7;  sr >>= 3;
  253. sr |= (uword)*c++ << 2;
  254. xmc[46] = sr & 0x7;  sr >>= 3;
  255. xmc[47] = sr & 0x7;  sr >>= 3;
  256. xmc[48] = sr & 0x7;  sr >>= 3;
  257. sr |= (uword)*c++ << 1;
  258. xmc[49] = sr & 0x7;  sr >>= 3;
  259. xmc[50] = sr & 0x7;  sr >>= 3;
  260. xmc[51] = sr & 0x7;  sr >>= 3;
  261. }
  262. }
  263. else
  264. #endif 
  265. {
  267. *c++ =   ((GSM_MAGIC & 0xF) << 4) /* 1 */
  268.        | ((LARc[0] >> 2) & 0xF);
  269. *c++ =   ((LARc[0] & 0x3) << 6)
  270.        | (LARc[1] & 0x3F);
  271. *c++ =   ((LARc[2] & 0x1F) << 3)
  272.        | ((LARc[3] >> 2) & 0x7);
  273. *c++ =   ((LARc[3] & 0x3) << 6)
  274.        | ((LARc[4] & 0xF) << 2)
  275.        | ((LARc[5] >> 2) & 0x3);
  276. *c++ =   ((LARc[5] & 0x3) << 6)
  277.        | ((LARc[6] & 0x7) << 3)
  278.        | (LARc[7] & 0x7);
  281. *c++ =   ((Nc[0] & 0x7F) << 1)
  284.        | ((bc[0] >> 1) & 0x1);
  285. *c++ =   ((bc[0] & 0x1) << 7)
  288.        | ((Mc[0] & 0x3) << 5)
  290.        | ((xmaxc[0] >> 1) & 0x1F);
  291. *c++ =   ((xmaxc[0] & 0x1) << 7)
  293. #undef xmc
  294. #define xmc (source + 12)
  296.        | ((xmc[0] & 0x7) << 4)
  297.        | ((xmc[1] & 0x7) << 1)
  298.        | ((xmc[2] >> 2) & 0x1);
  299. *c++ =   ((xmc[2] & 0x3) << 6)
  300.        | ((xmc[3] & 0x7) << 3)
  301.        | (xmc[4] & 0x7);
  302. *c++ =   ((xmc[5] & 0x7) << 5) /* 10 */
  303.        | ((xmc[6] & 0x7) << 2)
  304.        | ((xmc[7] >> 1) & 0x3);
  305. *c++ =   ((xmc[7] & 0x1) << 7)
  306.        | ((xmc[8] & 0x7) << 4)
  307.        | ((xmc[9] & 0x7) << 1)
  308.        | ((xmc[10] >> 2) & 0x1);
  309. *c++ =   ((xmc[10] & 0x3) << 6)
  310.        | ((xmc[11] & 0x7) << 3)
  311.        | (xmc[12] & 0x7);
  314. *c++ =   ((Nc[1] & 0x7F) << 1)
  317.        | ((bc[1] >> 1) & 0x1);
  318. *c++ =   ((bc[1] & 0x1) << 7)
  321.        | ((Mc[1] & 0x3) << 5)
  324.        | ((xmaxc[1] >> 1) & 0x1F);
  325. *c++ =   ((xmaxc[1] & 0x1) << 7)
  327. #undef xmc
  328. #define xmc (source + 29 - 13)
  330.        | ((xmc[13] & 0x7) << 4)
  331.        | ((xmc[14] & 0x7) << 1)
  332.        | ((xmc[15] >> 2) & 0x1);
  333. *c++ =   ((xmc[15] & 0x3) << 6)
  334.        | ((xmc[16] & 0x7) << 3)
  335.        | (xmc[17] & 0x7);
  336. *c++ =   ((xmc[18] & 0x7) << 5)
  337.        | ((xmc[19] & 0x7) << 2)
  338.        | ((xmc[20] >> 1) & 0x3);
  339. *c++ =   ((xmc[20] & 0x1) << 7)
  340.        | ((xmc[21] & 0x7) << 4)
  341.        | ((xmc[22] & 0x7) << 1)
  342.        | ((xmc[23] >> 2) & 0x1);
  343. *c++ =   ((xmc[23] & 0x3) << 6)
  344.        | ((xmc[24] & 0x7) << 3)
  345.        | (xmc[25] & 0x7);
  348. *c++ =   ((Nc[2] & 0x7F) << 1) /* 20 */
  351.        | ((bc[2] >> 1) & 0x1);
  352. *c++ =   ((bc[2] & 0x1) << 7)
  355.        | ((Mc[2] & 0x3) << 5)
  358.        | ((xmaxc[2] >> 1) & 0x1F);
  359. *c++ =   ((xmaxc[2] & 0x1) << 7)
  361. #undef xmc
  362. #define xmc (source + 46 - 26)
  364.        | ((xmc[26] & 0x7) << 4)
  365.        | ((xmc[27] & 0x7) << 1)
  366.        | ((xmc[28] >> 2) & 0x1);
  367. *c++ =   ((xmc[28] & 0x3) << 6)
  368.        | ((xmc[29] & 0x7) << 3)
  369.        | (xmc[30] & 0x7);
  370. *c++ =   ((xmc[31] & 0x7) << 5)
  371.        | ((xmc[32] & 0x7) << 2)
  372.        | ((xmc[33] >> 1) & 0x3);
  373. *c++ =   ((xmc[33] & 0x1) << 7)
  374.        | ((xmc[34] & 0x7) << 4)
  375.        | ((xmc[35] & 0x7) << 1)
  376.        | ((xmc[36] >> 2) & 0x1);
  377. *c++ =   ((xmc[36] & 0x3) << 6)
  378.        | ((xmc[37] & 0x7) << 3)
  379.        | (xmc[38] & 0x7);
  382. *c++ =   ((Nc[3] & 0x7F) << 1)
  385.        | ((bc[3] >> 1) & 0x1);
  386. *c++ =   ((bc[3] & 0x1) << 7)
  389.        | ((Mc[3] & 0x3) << 5)
  392.        | ((xmaxc[3] >> 1) & 0x1F);
  393. *c++ =   ((xmaxc[3] & 0x1) << 7)
  395. #undef xmc
  396. #define xmc (source + 63 - 39)
  398.        | ((xmc[39] & 0x7) << 4)
  399.        | ((xmc[40] & 0x7) << 1)
  400.        | ((xmc[41] >> 2) & 0x1);
  401. *c++ =   ((xmc[41] & 0x3) << 6) /* 30 */
  402.        | ((xmc[42] & 0x7) << 3)
  403.        | (xmc[43] & 0x7);
  404. *c++ =   ((xmc[44] & 0x7) << 5)
  405.        | ((xmc[45] & 0x7) << 2)
  406.        | ((xmc[46] >> 1) & 0x3);
  407. *c++ =   ((xmc[46] & 0x1) << 7)
  408.        | ((xmc[47] & 0x7) << 4)
  409.        | ((xmc[48] & 0x7) << 1)
  410.        | ((xmc[49] >> 2) & 0x1);
  411. *c++ =   ((xmc[49] & 0x3) << 6)
  412.        | ((xmc[50] & 0x7) << 3)
  413.        | (xmc[51] & 0x7);
  414. }
  415. }