X-Git-Url: http://git.eversberg.eu/gitweb.cgi?p=lcr.git;a=blobdiff_plain;f=gsm.cpp;h=9bfa1a5b25142583040fb4540751e98cdf2da2ec;hp=8e5a2d69b74677a594fc2191deeaf7b302174c23;hb=1e778230b935453d1183d8a457438221030dd5ee;hpb=03e00d7b37e755a4644739cdc5e3903d72c8e8d6

diff --git a/gsm.cpp b/gsm.cpp
index 8e5a2d6..9bfa1a5 100644
--- a/gsm.cpp
+++ b/gsm.cpp
@@ -139,6 +139,7 @@ Pgsm::Pgsm(int type, char *portname, struct port_settings *settings, struct inte
 	p_g_rtp_bridge = 0;
 	if (interface->rtp_bridge)
 		p_g_rtp_bridge = 1;
+	memset(&p_g_samples, 0, sizeof(p_g_samples));
 	SCPY(p_g_interface_name, interface->name); 
 	p_callerinfo.itype = (interface->extension)?INFO_ITYPE_ISDN_EXTENSION:INFO_ITYPE_ISDN;
 	memset(&p_g_delete, 0, sizeof(p_g_delete));
@@ -193,22 +194,42 @@ Pgsm::~Pgsm()
 void Pgsm::frame_receive(void *arg)
 {
 	struct gsm_data_frame *frame = (struct gsm_data_frame *)arg;
-	signed short samples[160];
 	unsigned char data[160];
 	int i;
 
 	if (!p_g_decoder)
 		return;
 
-	if ((frame->data[0]>>4) != 0xd)
-		PERROR("received GSM frame with wrong magig 0x%x\n", frame->data[0]>>4);
+	if (frame->msg_type != GSM_TCHF_BAD_FRAME) {
+		if ((frame->data[0]>>4) != 0xd)
+			PERROR("received GSM frame with wrong magig 0x%x\n", frame->data[0]>>4);
 	
-	/* decode */
-	gsm_audio_decode(p_g_decoder, frame->data, samples);
-	for (i = 0; i < 160; i++) {
-		data[i] = audio_s16_to_law[samples[i] & 0xffff];
+		/* decode */
+		gsm_audio_decode(p_g_decoder, frame->data, p_g_samples);
+		for (i = 0; i < 160; i++) {
+			data[i] = audio_s16_to_law[p_g_samples[i] & 0xffff];
+		}
+	} else 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];
+		}
 	}
 
+	/* local echo */
+	if (p_echotest)
+		bridge_rx(data, 160);
+
 	/* send to remote*/
 	bridge_tx(data, 160);
 }