+ switch (frame->msg_type) {
+ case GSM_TCHF_FRAME:
+ if (p_g_media_type != MEDIA_TYPE_GSM) {
+ PERROR("FR frame, but current media type mismatches.\n");
+ return;
+ }
+ if (!p_g_fr_decoder) {
+ PERROR("FR frame, but decoder not created.\n");
+ return;
+ }
+ if ((frame->data[0]>>4) != 0xd) {
+ PDEBUG(DEBUG_GSM, "received GSM frame with wrong magig 0x%x\n", frame->data[0]>>4);
+ goto bfi;
+ }
+#ifdef WITH_GSMFR
+ /* decode */
+ gsm_fr_decode(p_g_fr_decoder, frame->data, p_g_samples);
+ for (i = 0; i < 160; i++) {
+ data[i] = audio_s16_to_law[p_g_samples[i] & 0xffff];
+ }
+#endif
+ break;
+ case GSM_TCHH_FRAME:
+ if (p_g_media_type != MEDIA_TYPE_GSM_HR) {
+ PERROR("HR frame, but current media type mismatches.\n");
+ return;
+ }
+ if (!p_g_hr_decoder) {
+ PERROR("HR frame, but decoder not created.\n");
+ return;
+ }
+ if ((frame->data[0]>>4) != 0x0)
+ goto bfi;
+#ifdef WITH_GSMHR
+ /* decode */
+ if (gsm_hr_decode(p_g_hr_decoder, frame->data, p_g_samples))
+ goto bfi;
+ for (i = 0; i < 160; i++) {
+ data[i] = audio_s16_to_law[p_g_samples[i] & 0xffff];
+ }
+#endif
+ break;
+ case GSM_TCHF_FRAME_EFR:
+ if (p_g_media_type != MEDIA_TYPE_GSM_EFR) {
+ PERROR("EFR frame, but current media type mismatches.\n");
+ return;
+ }
+ if (!p_g_amr_decoder) {
+ PERROR("EFR frame, but decoder not created.\n");
+ return;
+ }
+ if ((frame->data[0]>>4) != 0xc)
+ goto bfi;
+#ifdef WITH_GSMAMR
+ /* decode */
+ gsm_efr_decode(p_g_amr_decoder, frame->data, p_g_samples);
+ for (i = 0; i < 160; i++) {
+ data[i] = audio_s16_to_law[p_g_samples[i] & 0xffff];
+ }
+#endif
+ break;
+ case GSM_TCH_FRAME_AMR:
+ if (p_g_media_type != MEDIA_TYPE_AMR) {
+ PERROR("AMR frame, but current media type mismatches.\n");
+ return;
+ }
+ if (!p_g_amr_decoder) {
+ PERROR("AMR frame, but decoder not created.\n");
+ return;
+ }
+ cmr = (frame->data[1] >> 4);
+ if (cmr <= 7) {
+ p_g_amr_cmr = cmr;
+ p_g_amr_cmr_valid = 1;
+ }
+ if (!(frame->data[2] & 0x04))
+ goto bfi;
+#ifdef WITH_GSMAMR
+ /* decode (skip length byte in front) */
+ gsm_amr_decode(p_g_amr_decoder, frame->data + 1, p_g_samples);
+ for (i = 0; i < 160; i++) {
+ data[i] = audio_s16_to_law[p_g_samples[i] & 0xffff];
+ }
+#endif
+ break;
+ case GSM_BAD_FRAME:
+ default:
+bfi:
+ if (p_echotest) {
+ /* beep on bad frame */
+ for (i = 0; i < 160; i++) {
+ if ((i & 3) > 2)
+ p_g_samples[i] = 15000;
+ else
+ p_g_samples[i] = -15000;
+ data[i] = audio_s16_to_law[p_g_samples[i] & 0xffff];
+ }
+ } else {
+ /* repeat on bad frame */
+ for (i = 0; i < 160; i++) {
+ p_g_samples[i] = (p_g_samples[i] * 14) >> 4;
+ data[i] = audio_s16_to_law[p_g_samples[i] & 0xffff];
+ }
+ }