1/*
2 *  Copyright (c) 2012 The WebRTC project authors. All Rights Reserved.
3 *
4 *  Use of this source code is governed by a BSD-style license
5 *  that can be found in the LICENSE file in the root of the source
6 *  tree. An additional intellectual property rights grant can be found
7 *  in the file PATENTS.  All contributing project authors may
8 *  be found in the AUTHORS file in the root of the source tree.
9 */
10
11//TODO(hlundin): Reformat file to meet style guide.
12
13/* header includes */
14#include <stdio.h>
15#include <stdlib.h>
16#include <string.h>
17#ifdef WIN32
18#include <winsock2.h>
19#endif
20#ifdef WEBRTC_LINUX
21#include <netinet/in.h>
22#endif
23
24#include <assert.h>
25
26#include "webrtc/typedefs.h"
27// needed for NetEqDecoder
28#include "webrtc/modules/audio_coding/neteq/interface/audio_decoder.h"
29#include "webrtc/modules/audio_coding/neteq/interface/neteq.h"
30
31/************************/
32/* Define payload types */
33/************************/
34
35#include "PayloadTypes.h"
36
37
38
39/*********************/
40/* Misc. definitions */
41/*********************/
42
43#define STOPSENDTIME 3000
44#define RESTARTSENDTIME 0 //162500
45#define FIRSTLINELEN 40
46#define CHECK_NOT_NULL(a) if((a)==0){printf("\n %s \n line: %d \nerror at %s\n",__FILE__,__LINE__,#a );return(-1);}
47
48//#define MULTIPLE_SAME_TIMESTAMP
49#define REPEAT_PACKET_DISTANCE 17
50#define REPEAT_PACKET_COUNT 1  // number of extra packets to send
51
52//#define INSERT_OLD_PACKETS
53#define OLD_PACKET 5 // how many seconds too old should the packet be?
54
55//#define TIMESTAMP_WRAPAROUND
56
57//#define RANDOM_DATA
58//#define RANDOM_PAYLOAD_DATA
59#define RANDOM_SEED 10
60
61//#define INSERT_DTMF_PACKETS
62//#define NO_DTMF_OVERDUB
63#define DTMF_PACKET_INTERVAL 2000
64#define DTMF_DURATION 500
65
66#define STEREO_MODE_FRAME 0
67#define STEREO_MODE_SAMPLE_1 1 //1 octet per sample
68#define STEREO_MODE_SAMPLE_2 2 //2 octets per sample
69
70/*************************/
71/* Function declarations */
72/*************************/
73
74void NetEQTest_GetCodec_and_PT(char * name, webrtc::NetEqDecoder *codec, int *PT, int frameLen, int *fs, int *bitrate, int *useRed);
75int NetEQTest_init_coders(webrtc::NetEqDecoder coder, int enc_frameSize, int bitrate, int sampfreq , int vad, int numChannels);
76void defineCodecs(webrtc::NetEqDecoder *usedCodec, int *noOfCodecs );
77int NetEQTest_free_coders(webrtc::NetEqDecoder coder, int numChannels);
78int NetEQTest_encode(int coder, int16_t *indata, int frameLen, unsigned char * encoded,int sampleRate , int * vad, int useVAD, int bitrate, int numChannels);
79void makeRTPheader(unsigned char* rtp_data, int payloadType, int seqNo, uint32_t timestamp, uint32_t ssrc);
80int makeRedundantHeader(unsigned char* rtp_data, int *payloadType, int numPayloads, uint32_t *timestamp, uint16_t *blockLen,
81                        int seqNo, uint32_t ssrc);
82int makeDTMFpayload(unsigned char* payload_data, int Event, int End, int Volume, int Duration);
83void stereoDeInterleave(int16_t* audioSamples, int numSamples);
84void stereoInterleave(unsigned char* data, int dataLen, int stride);
85
86/*********************/
87/* Codec definitions */
88/*********************/
89
90#include "webrtc_vad.h"
91
92#if ((defined CODEC_PCM16B)||(defined NETEQ_ARBITRARY_CODEC))
93	#include "pcm16b.h"
94#endif
95#ifdef CODEC_G711
96	#include "g711_interface.h"
97#endif
98#ifdef CODEC_G729
99	#include "G729Interface.h"
100#endif
101#ifdef CODEC_G729_1
102	#include "G729_1Interface.h"
103#endif
104#ifdef CODEC_AMR
105	#include "AMRInterface.h"
106	#include "AMRCreation.h"
107#endif
108#ifdef CODEC_AMRWB
109	#include "AMRWBInterface.h"
110	#include "AMRWBCreation.h"
111#endif
112#ifdef CODEC_ILBC
113	#include "ilbc.h"
114#endif
115#if (defined CODEC_ISAC || defined CODEC_ISAC_SWB)
116	#include "isac.h"
117#endif
118#ifdef NETEQ_ISACFIX_CODEC
119	#include "isacfix.h"
120	#ifdef CODEC_ISAC
121		#error Cannot have both ISAC and ISACfix defined. Please de-select one in the beginning of RTPencode.cpp
122	#endif
123#endif
124#ifdef CODEC_G722
125	#include "g722_interface.h"
126#endif
127#ifdef CODEC_G722_1_24
128	#include "G722_1Interface.h"
129#endif
130#ifdef CODEC_G722_1_32
131	#include "G722_1Interface.h"
132#endif
133#ifdef CODEC_G722_1_16
134	#include "G722_1Interface.h"
135#endif
136#ifdef CODEC_G722_1C_24
137	#include "G722_1Interface.h"
138#endif
139#ifdef CODEC_G722_1C_32
140	#include "G722_1Interface.h"
141#endif
142#ifdef CODEC_G722_1C_48
143	#include "G722_1Interface.h"
144#endif
145#ifdef CODEC_G726
146    #include "G726Creation.h"
147    #include "G726Interface.h"
148#endif
149#ifdef CODEC_GSMFR
150	#include "GSMFRInterface.h"
151	#include "GSMFRCreation.h"
152#endif
153#if (defined(CODEC_CNGCODEC8) || defined(CODEC_CNGCODEC16) || \
154    defined(CODEC_CNGCODEC32) || defined(CODEC_CNGCODEC48))
155  #include "webrtc_cng.h"
156#endif
157#if ((defined CODEC_SPEEX_8)||(defined CODEC_SPEEX_16))
158	#include "SpeexInterface.h"
159#endif
160#ifdef CODEC_CELT_32
161#include "celt_interface.h"
162#endif
163
164
165/***********************************/
166/* Global codec instance variables */
167/***********************************/
168
169WebRtcVadInst *VAD_inst[2];
170
171#ifdef CODEC_G722
172    G722EncInst *g722EncState[2];
173#endif
174
175#ifdef CODEC_G722_1_24
176	G722_1_24_encinst_t *G722_1_24enc_inst[2];
177#endif
178#ifdef CODEC_G722_1_32
179	G722_1_32_encinst_t *G722_1_32enc_inst[2];
180#endif
181#ifdef CODEC_G722_1_16
182	G722_1_16_encinst_t *G722_1_16enc_inst[2];
183#endif
184#ifdef CODEC_G722_1C_24
185	G722_1C_24_encinst_t *G722_1C_24enc_inst[2];
186#endif
187#ifdef CODEC_G722_1C_32
188	G722_1C_32_encinst_t *G722_1C_32enc_inst[2];
189#endif
190#ifdef CODEC_G722_1C_48
191	G722_1C_48_encinst_t *G722_1C_48enc_inst[2];
192#endif
193#ifdef CODEC_G726
194    G726_encinst_t *G726enc_inst[2];
195#endif
196#ifdef CODEC_G729
197	G729_encinst_t *G729enc_inst[2];
198#endif
199#ifdef CODEC_G729_1
200	G729_1_inst_t *G729_1_inst[2];
201#endif
202#ifdef CODEC_AMR
203	AMR_encinst_t *AMRenc_inst[2];
204	int16_t		  AMR_bitrate;
205#endif
206#ifdef CODEC_AMRWB
207	AMRWB_encinst_t *AMRWBenc_inst[2];
208	int16_t		  AMRWB_bitrate;
209#endif
210#ifdef CODEC_ILBC
211	iLBC_encinst_t *iLBCenc_inst[2];
212#endif
213#ifdef CODEC_ISAC
214	ISACStruct *ISAC_inst[2];
215#endif
216#ifdef NETEQ_ISACFIX_CODEC
217	ISACFIX_MainStruct *ISAC_inst[2];
218#endif
219#ifdef CODEC_ISAC_SWB
220	ISACStruct *ISACSWB_inst[2];
221#endif
222#ifdef CODEC_GSMFR
223	GSMFR_encinst_t *GSMFRenc_inst[2];
224#endif
225#if (defined(CODEC_CNGCODEC8) || defined(CODEC_CNGCODEC16) || \
226    defined(CODEC_CNGCODEC32) || defined(CODEC_CNGCODEC48))
227	CNG_enc_inst *CNGenc_inst[2];
228#endif
229#ifdef CODEC_SPEEX_8
230	SPEEX_encinst_t *SPEEX8enc_inst[2];
231#endif
232#ifdef CODEC_SPEEX_16
233	SPEEX_encinst_t *SPEEX16enc_inst[2];
234#endif
235#ifdef CODEC_CELT_32
236  CELT_encinst_t *CELT32enc_inst[2];
237#endif
238#ifdef CODEC_G711
239    void *G711state[2]={NULL, NULL};
240#endif
241
242
243int main(int argc, char* argv[])
244{
245	int packet_size, fs;
246	webrtc::NetEqDecoder usedCodec;
247	int payloadType;
248	int bitrate = 0;
249	int useVAD, vad;
250    int useRed=0;
251	int len, enc_len;
252	int16_t org_data[4000];
253	unsigned char rtp_data[8000];
254	int16_t seqNo=0xFFF;
255	uint32_t ssrc=1235412312;
256	uint32_t timestamp=0xAC1245;
257        uint16_t length, plen;
258	uint32_t offset;
259	double sendtime = 0;
260    int red_PT[2] = {0};
261    uint32_t red_TS[2] = {0};
262    uint16_t red_len[2] = {0};
263    int RTPheaderLen=12;
264	unsigned char red_data[8000];
265#ifdef INSERT_OLD_PACKETS
266	uint16_t old_length, old_plen;
267	int old_enc_len;
268	int first_old_packet=1;
269	unsigned char old_rtp_data[8000];
270	int packet_age=0;
271#endif
272#ifdef INSERT_DTMF_PACKETS
273	int NTone = 1;
274	int DTMFfirst = 1;
275	uint32_t DTMFtimestamp;
276    bool dtmfSent = false;
277#endif
278    bool usingStereo = false;
279    int stereoMode = 0;
280    int numChannels = 1;
281
282	/* check number of parameters */
283	if ((argc != 6) && (argc != 7)) {
284		/* print help text and exit */
285		printf("Application to encode speech into an RTP stream.\n");
286		printf("The program reads a PCM file and encodes is using the specified codec.\n");
287		printf("The coded speech is packetized in RTP packest and written to the output file.\n");
288		printf("The format of the RTP stream file is simlilar to that of rtpplay,\n");
289		printf("but with the receive time euqal to 0 for all packets.\n");
290		printf("Usage:\n\n");
291		printf("%s PCMfile RTPfile frameLen codec useVAD bitrate\n", argv[0]);
292		printf("where:\n");
293
294		printf("PCMfile      : PCM speech input file\n\n");
295
296		printf("RTPfile      : RTP stream output file\n\n");
297
298		printf("frameLen     : 80...960...  Number of samples per packet (limit depends on codec)\n\n");
299
300		printf("codecName\n");
301#ifdef CODEC_PCM16B
302		printf("             : pcm16b       16 bit PCM (8kHz)\n");
303#endif
304#ifdef CODEC_PCM16B_WB
305		printf("             : pcm16b_wb   16 bit PCM (16kHz)\n");
306#endif
307#ifdef CODEC_PCM16B_32KHZ
308		printf("             : pcm16b_swb32 16 bit PCM (32kHz)\n");
309#endif
310#ifdef CODEC_PCM16B_48KHZ
311		printf("             : pcm16b_swb48 16 bit PCM (48kHz)\n");
312#endif
313#ifdef CODEC_G711
314		printf("             : pcma         g711 A-law (8kHz)\n");
315#endif
316#ifdef CODEC_G711
317		printf("             : pcmu         g711 u-law (8kHz)\n");
318#endif
319#ifdef CODEC_G729
320		printf("             : g729         G729 (8kHz and 8kbps) CELP (One-Three frame(s)/packet)\n");
321#endif
322#ifdef CODEC_G729_1
323		printf("             : g729.1       G729.1 (16kHz) variable rate (8--32 kbps)\n");
324#endif
325#ifdef CODEC_G722_1_16
326		printf("             : g722.1_16    G722.1 coder (16kHz) (g722.1 with 16kbps)\n");
327#endif
328#ifdef CODEC_G722_1_24
329		printf("             : g722.1_24    G722.1 coder (16kHz) (the 24kbps version)\n");
330#endif
331#ifdef CODEC_G722_1_32
332		printf("             : g722.1_32    G722.1 coder (16kHz) (the 32kbps version)\n");
333#endif
334#ifdef CODEC_G722_1C_24
335		printf("             : g722.1C_24    G722.1 C coder (32kHz) (the 24kbps version)\n");
336#endif
337#ifdef CODEC_G722_1C_32
338		printf("             : g722.1C_32    G722.1 C coder (32kHz) (the 32kbps version)\n");
339#endif
340#ifdef CODEC_G722_1C_48
341		printf("             : g722.1C_48    G722.1 C coder (32kHz) (the 48kbps)\n");
342#endif
343
344#ifdef CODEC_G726
345        printf("             : g726_16      G726 coder (8kHz) 16kbps\n");
346        printf("             : g726_24      G726 coder (8kHz) 24kbps\n");
347        printf("             : g726_32      G726 coder (8kHz) 32kbps\n");
348        printf("             : g726_40      G726 coder (8kHz) 40kbps\n");
349#endif
350#ifdef CODEC_AMR
351		printf("             : AMRXk        Adaptive Multi Rate CELP codec (8kHz)\n");
352		printf("                            X = 4.75, 5.15, 5.9, 6.7, 7.4, 7.95, 10.2 or 12.2\n");
353#endif
354#ifdef CODEC_AMRWB
355		printf("             : AMRwbXk      Adaptive Multi Rate Wideband CELP codec (16kHz)\n");
356		printf("                            X = 7, 9, 12, 14, 16, 18, 20, 23 or 24\n");
357#endif
358#ifdef CODEC_ILBC
359		printf("             : ilbc         iLBC codec (8kHz and 13.8kbps)\n");
360#endif
361#ifdef CODEC_ISAC
362		printf("             : isac         iSAC (16kHz and 32.0 kbps). To set rate specify a rate parameter as last parameter\n");
363#endif
364#ifdef CODEC_ISAC_SWB
365		printf("             : isacswb       iSAC SWB (32kHz and 32.0-52.0 kbps). To set rate specify a rate parameter as last parameter\n");
366#endif
367#ifdef CODEC_GSMFR
368		printf("             : gsmfr        GSM FR codec (8kHz and 13kbps)\n");
369#endif
370#ifdef CODEC_G722
371		printf("             : g722         g722 coder (16kHz) (the 64kbps version)\n");
372#endif
373#ifdef CODEC_SPEEX_8
374		printf("             : speex8       speex coder (8 kHz)\n");
375#endif
376#ifdef CODEC_SPEEX_16
377		printf("             : speex16      speex coder (16 kHz)\n");
378#endif
379#ifdef CODEC_CELT_32
380    printf("             : celt32       celt coder (32 kHz)\n");
381#endif
382#ifdef CODEC_RED
383#ifdef CODEC_G711
384		printf("             : red_pcm      Redundancy RTP packet with 2*G711A frames\n");
385#endif
386#ifdef CODEC_ISAC
387		printf("             : red_isac     Redundancy RTP packet with 2*iSAC frames\n");
388#endif
389#endif
390        printf("\n");
391
392#if (defined(CODEC_CNGCODEC8) || defined(CODEC_CNGCODEC16) || \
393    defined(CODEC_CNGCODEC32) || defined(CODEC_CNGCODEC48))
394		printf("useVAD       : 0 Voice Activity Detection is switched off\n");
395		printf("             : 1 Voice Activity Detection is switched on\n\n");
396#else
397		printf("useVAD       : 0 Voice Activity Detection switched off (on not supported)\n\n");
398#endif
399		printf("bitrate      : Codec bitrate in bps (only applies to vbr codecs)\n\n");
400
401		return(0);
402	}
403
404	FILE* in_file=fopen(argv[1],"rb");
405	CHECK_NOT_NULL(in_file);
406	printf("Input file: %s\n",argv[1]);
407	FILE* out_file=fopen(argv[2],"wb");
408	CHECK_NOT_NULL(out_file);
409	printf("Output file: %s\n\n",argv[2]);
410	packet_size=atoi(argv[3]);
411	CHECK_NOT_NULL(packet_size);
412	printf("Packet size: %i\n",packet_size);
413
414    // check for stereo
415    if(argv[4][strlen(argv[4])-1] == '*') {
416        // use stereo
417        usingStereo = true;
418        numChannels = 2;
419        argv[4][strlen(argv[4])-1] = '\0';
420    }
421
422	NetEQTest_GetCodec_and_PT(argv[4], &usedCodec, &payloadType, packet_size, &fs, &bitrate, &useRed);
423
424    if(useRed) {
425        RTPheaderLen = 12 + 4 + 1; /* standard RTP = 12; 4 bytes per redundant payload, except last one which is 1 byte */
426    }
427
428	useVAD=atoi(argv[5]);
429#if !(defined(CODEC_CNGCODEC8) || defined(CODEC_CNGCODEC16) || \
430    defined(CODEC_CNGCODEC32) || defined(CODEC_CNGCODEC48))
431	if (useVAD!=0) {
432		printf("Error: this simulation does not support VAD/DTX/CNG\n");
433	}
434#endif
435
436    // check stereo type
437    if(usingStereo)
438    {
439        switch(usedCodec)
440        {
441            // sample based codecs
442        case webrtc::kDecoderPCMu:
443        case webrtc::kDecoderPCMa:
444        case webrtc::kDecoderG722:
445            {
446                // 1 octet per sample
447                stereoMode = STEREO_MODE_SAMPLE_1;
448                break;
449            }
450        case webrtc::kDecoderPCM16B:
451        case webrtc::kDecoderPCM16Bwb:
452        case webrtc::kDecoderPCM16Bswb32kHz:
453        case webrtc::kDecoderPCM16Bswb48kHz:
454            {
455                // 2 octets per sample
456                stereoMode = STEREO_MODE_SAMPLE_2;
457                break;
458            }
459
460            // fixed-rate frame codecs (with internal VAD)
461        default:
462            {
463                printf("Cannot use codec %s as stereo codec\n", argv[4]);
464                exit(0);
465            }
466        }
467    }
468
469	if ((usedCodec == webrtc::kDecoderISAC) || (usedCodec == webrtc::kDecoderISACswb))
470    {
471        if (argc != 7)
472        {
473            if (usedCodec == webrtc::kDecoderISAC)
474            {
475                bitrate = 32000;
476                printf(
477                    "Running iSAC at default bitrate of 32000 bps (to specify explicitly add the bps as last parameter)\n");
478            }
479            else // (usedCodec==webrtc::kDecoderISACswb)
480            {
481                bitrate = 56000;
482                printf(
483                    "Running iSAC at default bitrate of 56000 bps (to specify explicitly add the bps as last parameter)\n");
484            }
485        }
486        else
487        {
488            bitrate = atoi(argv[6]);
489            if (usedCodec == webrtc::kDecoderISAC)
490            {
491                if ((bitrate < 10000) || (bitrate > 32000))
492                {
493                    printf(
494                        "Error: iSAC bitrate must be between 10000 and 32000 bps (%i is invalid)\n",
495                        bitrate);
496                    exit(0);
497                }
498                printf("Running iSAC at bitrate of %i bps\n", bitrate);
499            }
500            else // (usedCodec==webrtc::kDecoderISACswb)
501            {
502                if ((bitrate < 32000) || (bitrate > 56000))
503                {
504                    printf(
505                        "Error: iSAC SWB bitrate must be between 32000 and 56000 bps (%i is invalid)\n",
506                        bitrate);
507                    exit(0);
508                }
509            }
510        }
511    }
512    else
513    {
514        if (argc == 7)
515        {
516            printf(
517                "Error: Bitrate parameter can only be specified for iSAC, G.723, and G.729.1\n");
518            exit(0);
519        }
520    }
521
522    if(useRed) {
523        printf("Redundancy engaged. ");
524    }
525	printf("Used codec: %i\n",usedCodec);
526	printf("Payload type: %i\n",payloadType);
527
528	NetEQTest_init_coders(usedCodec, packet_size, bitrate, fs, useVAD, numChannels);
529
530	/* write file header */
531	//fprintf(out_file, "#!RTPencode%s\n", "1.0");
532	fprintf(out_file, "#!rtpplay%s \n", "1.0"); // this is the string that rtpplay needs
533	uint32_t dummy_variable = 0; // should be converted to network endian format, but does not matter when 0
534        if (fwrite(&dummy_variable, 4, 1, out_file) != 1) {
535          return -1;
536        }
537        if (fwrite(&dummy_variable, 4, 1, out_file) != 1) {
538          return -1;
539        }
540        if (fwrite(&dummy_variable, 4, 1, out_file) != 1) {
541          return -1;
542        }
543        if (fwrite(&dummy_variable, 2, 1, out_file) != 1) {
544          return -1;
545        }
546        if (fwrite(&dummy_variable, 2, 1, out_file) != 1) {
547          return -1;
548        }
549
550#ifdef TIMESTAMP_WRAPAROUND
551	timestamp = 0xFFFFFFFF - fs*10; /* should give wrap-around in 10 seconds */
552#endif
553#if defined(RANDOM_DATA) | defined(RANDOM_PAYLOAD_DATA)
554	srand(RANDOM_SEED);
555#endif
556
557    /* if redundancy is used, the first redundant payload is zero length */
558    red_len[0] = 0;
559
560	/* read first frame */
561	len=fread(org_data,2,packet_size * numChannels,in_file) / numChannels;
562
563    /* de-interleave if stereo */
564    if ( usingStereo )
565    {
566        stereoDeInterleave(org_data, len * numChannels);
567    }
568
569	while (len==packet_size) {
570
571#ifdef INSERT_DTMF_PACKETS
572        dtmfSent = false;
573
574        if ( sendtime >= NTone * DTMF_PACKET_INTERVAL ) {
575            if ( sendtime < NTone * DTMF_PACKET_INTERVAL + DTMF_DURATION ) {
576                // tone has not ended
577                if (DTMFfirst==1) {
578                    DTMFtimestamp = timestamp; // save this timestamp
579                    DTMFfirst=0;
580                }
581                makeRTPheader(rtp_data, NETEQ_CODEC_AVT_PT, seqNo,DTMFtimestamp, ssrc);
582                enc_len = makeDTMFpayload(&rtp_data[12], NTone % 12, 0, 4, (int) (sendtime - NTone * DTMF_PACKET_INTERVAL)*(fs/1000) + len);
583            }
584            else {
585                // tone has ended
586                makeRTPheader(rtp_data, NETEQ_CODEC_AVT_PT, seqNo,DTMFtimestamp, ssrc);
587                enc_len = makeDTMFpayload(&rtp_data[12], NTone % 12, 1, 4, DTMF_DURATION*(fs/1000));
588                NTone++;
589                DTMFfirst=1;
590            }
591
592            /* write RTP packet to file */
593            length = htons(12 + enc_len + 8);
594            plen = htons(12 + enc_len);
595            offset = (uint32_t) sendtime; //(timestamp/(fs/1000));
596            offset = htonl(offset);
597            if (fwrite(&length, 2, 1, out_file) != 1) {
598              return -1;
599            }
600            if (fwrite(&plen, 2, 1, out_file) != 1) {
601              return -1;
602            }
603            if (fwrite(&offset, 4, 1, out_file) != 1) {
604              return -1;
605            }
606            if (fwrite(rtp_data, 12 + enc_len, 1, out_file) != 1) {
607              return -1;
608            }
609
610            dtmfSent = true;
611        }
612#endif
613
614#ifdef NO_DTMF_OVERDUB
615        /* If DTMF is sent, we should not send any speech packets during the same time */
616        if (dtmfSent) {
617            enc_len = 0;
618        }
619        else {
620#endif
621		/* encode frame */
622		enc_len=NetEQTest_encode(usedCodec, org_data, packet_size, &rtp_data[12] ,fs,&vad, useVAD, bitrate, numChannels);
623		if (enc_len==-1) {
624			printf("Error encoding frame\n");
625			exit(0);
626		}
627
628        if ( usingStereo &&
629            stereoMode != STEREO_MODE_FRAME &&
630            vad == 1 )
631        {
632            // interleave the encoded payload for sample-based codecs (not for CNG)
633            stereoInterleave(&rtp_data[12], enc_len, stereoMode);
634        }
635#ifdef NO_DTMF_OVERDUB
636        }
637#endif
638
639		if (enc_len > 0 && (sendtime <= STOPSENDTIME || sendtime > RESTARTSENDTIME)) {
640            if(useRed) {
641                if(red_len[0] > 0) {
642                    memmove(&rtp_data[RTPheaderLen+red_len[0]], &rtp_data[12], enc_len);
643                    memcpy(&rtp_data[RTPheaderLen], red_data, red_len[0]);
644
645                    red_len[1] = enc_len;
646                    red_TS[1] = timestamp;
647                    if(vad)
648                        red_PT[1] = payloadType;
649                    else
650                        red_PT[1] = NETEQ_CODEC_CN_PT;
651
652                    makeRedundantHeader(rtp_data, red_PT, 2, red_TS, red_len, seqNo++, ssrc);
653
654
655                    enc_len += red_len[0] + RTPheaderLen - 12;
656                }
657                else { // do not use redundancy payload for this packet, i.e., only last payload
658                    memmove(&rtp_data[RTPheaderLen-4], &rtp_data[12], enc_len);
659                    //memcpy(&rtp_data[RTPheaderLen], red_data, red_len[0]);
660
661                    red_len[1] = enc_len;
662                    red_TS[1] = timestamp;
663                    if(vad)
664                        red_PT[1] = payloadType;
665                    else
666                        red_PT[1] = NETEQ_CODEC_CN_PT;
667
668                    makeRedundantHeader(rtp_data, red_PT, 2, red_TS, red_len, seqNo++, ssrc);
669
670
671                    enc_len += red_len[0] + RTPheaderLen - 4 - 12; // 4 is length of redundancy header (not used)
672                }
673            }
674            else {
675
676                /* make RTP header */
677                if (vad) // regular speech data
678                    makeRTPheader(rtp_data, payloadType, seqNo++,timestamp, ssrc);
679                else // CNG data
680                    makeRTPheader(rtp_data, NETEQ_CODEC_CN_PT, seqNo++,timestamp, ssrc);
681
682            }
683#ifdef MULTIPLE_SAME_TIMESTAMP
684			int mult_pack=0;
685			do {
686#endif //MULTIPLE_SAME_TIMESTAMP
687			/* write RTP packet to file */
688                          length = htons(12 + enc_len + 8);
689                          plen = htons(12 + enc_len);
690                          offset = (uint32_t) sendtime;
691                          //(timestamp/(fs/1000));
692                          offset = htonl(offset);
693                          if (fwrite(&length, 2, 1, out_file) != 1) {
694                            return -1;
695                          }
696                          if (fwrite(&plen, 2, 1, out_file) != 1) {
697                            return -1;
698                          }
699                          if (fwrite(&offset, 4, 1, out_file) != 1) {
700                            return -1;
701                          }
702#ifdef RANDOM_DATA
703			for (int k=0; k<12+enc_len; k++) {
704				rtp_data[k] = rand() + rand();
705			}
706#endif
707#ifdef RANDOM_PAYLOAD_DATA
708			for (int k=12; k<12+enc_len; k++) {
709				rtp_data[k] = rand() + rand();
710			}
711#endif
712                        if (fwrite(rtp_data, 12 + enc_len, 1, out_file) != 1) {
713                          return -1;
714                        }
715#ifdef MULTIPLE_SAME_TIMESTAMP
716			} while ( (seqNo%REPEAT_PACKET_DISTANCE == 0) && (mult_pack++ < REPEAT_PACKET_COUNT) );
717#endif //MULTIPLE_SAME_TIMESTAMP
718
719#ifdef INSERT_OLD_PACKETS
720			if (packet_age >= OLD_PACKET*fs) {
721				if (!first_old_packet) {
722                                  // send the old packet
723                                  if (fwrite(&old_length, 2, 1,
724                                             out_file) != 1) {
725                                    return -1;
726                                  }
727                                  if (fwrite(&old_plen, 2, 1,
728                                             out_file) != 1) {
729                                    return -1;
730                                  }
731                                  if (fwrite(&offset, 4, 1,
732                                             out_file) != 1) {
733                                    return -1;
734                                  }
735                                  if (fwrite(old_rtp_data, 12 + old_enc_len,
736                                             1, out_file) != 1) {
737                                    return -1;
738                                  }
739				}
740				// store current packet as old
741				old_length=length;
742				old_plen=plen;
743				memcpy(old_rtp_data,rtp_data,12+enc_len);
744				old_enc_len=enc_len;
745				first_old_packet=0;
746				packet_age=0;
747
748			}
749			packet_age += packet_size;
750#endif
751
752            if(useRed) {
753                /* move data to redundancy store */
754#ifdef CODEC_ISAC
755                if(usedCodec==webrtc::kDecoderISAC)
756                {
757                    assert(!usingStereo); // Cannot handle stereo yet
758                    red_len[0] = WebRtcIsac_GetRedPayload(ISAC_inst[0], (int16_t*)red_data);
759                }
760                else
761                {
762#endif
763                    memcpy(red_data, &rtp_data[RTPheaderLen+red_len[0]], enc_len);
764                    red_len[0]=red_len[1];
765#ifdef CODEC_ISAC
766                }
767#endif
768                red_TS[0]=red_TS[1];
769                red_PT[0]=red_PT[1];
770            }
771
772		}
773
774		/* read next frame */
775        len=fread(org_data,2,packet_size * numChannels,in_file) / numChannels;
776        /* de-interleave if stereo */
777        if ( usingStereo )
778        {
779            stereoDeInterleave(org_data, len * numChannels);
780        }
781
782        if (payloadType==NETEQ_CODEC_G722_PT)
783            timestamp+=len>>1;
784        else
785            timestamp+=len;
786
787		sendtime += (double) len/(fs/1000);
788	}
789
790	NetEQTest_free_coders(usedCodec, numChannels);
791	fclose(in_file);
792	fclose(out_file);
793    printf("Done!\n");
794
795	return(0);
796}
797
798
799
800
801/****************/
802/* Subfunctions */
803/****************/
804
805void NetEQTest_GetCodec_and_PT(char * name, webrtc::NetEqDecoder *codec, int *PT, int frameLen, int *fs, int *bitrate, int *useRed) {
806
807	*bitrate = 0; /* Default bitrate setting */
808    *useRed = 0; /* Default no redundancy */
809
810	if(!strcmp(name,"pcmu")){
811		*codec=webrtc::kDecoderPCMu;
812		*PT=NETEQ_CODEC_PCMU_PT;
813		*fs=8000;
814	}
815	else if(!strcmp(name,"pcma")){
816		*codec=webrtc::kDecoderPCMa;
817		*PT=NETEQ_CODEC_PCMA_PT;
818		*fs=8000;
819	}
820	else if(!strcmp(name,"pcm16b")){
821		*codec=webrtc::kDecoderPCM16B;
822		*PT=NETEQ_CODEC_PCM16B_PT;
823		*fs=8000;
824	}
825	else if(!strcmp(name,"pcm16b_wb")){
826		*codec=webrtc::kDecoderPCM16Bwb;
827		*PT=NETEQ_CODEC_PCM16B_WB_PT;
828		*fs=16000;
829	}
830	else if(!strcmp(name,"pcm16b_swb32")){
831		*codec=webrtc::kDecoderPCM16Bswb32kHz;
832		*PT=NETEQ_CODEC_PCM16B_SWB32KHZ_PT;
833		*fs=32000;
834	}
835	else if(!strcmp(name,"pcm16b_swb48")){
836		*codec=webrtc::kDecoderPCM16Bswb48kHz;
837		*PT=NETEQ_CODEC_PCM16B_SWB48KHZ_PT;
838		*fs=48000;
839	}
840	else if(!strcmp(name,"g722")){
841		*codec=webrtc::kDecoderG722;
842		*PT=NETEQ_CODEC_G722_PT;
843		*fs=16000;
844	}
845	else if((!strcmp(name,"ilbc"))&&((frameLen%240==0)||(frameLen%160==0))){
846		*fs=8000;
847		*codec=webrtc::kDecoderILBC;
848		*PT=NETEQ_CODEC_ILBC_PT;
849	}
850	else if(!strcmp(name,"isac")){
851		*fs=16000;
852		*codec=webrtc::kDecoderISAC;
853		*PT=NETEQ_CODEC_ISAC_PT;
854	}
855    else if(!strcmp(name,"isacswb")){
856		*fs=32000;
857		*codec=webrtc::kDecoderISACswb;
858		*PT=NETEQ_CODEC_ISACSWB_PT;
859	}
860  else if(!strcmp(name,"celt32")){
861    *fs=32000;
862    *codec=webrtc::kDecoderCELT_32;
863    *PT=NETEQ_CODEC_CELT32_PT;
864  }
865    else if(!strcmp(name,"red_pcm")){
866		*codec=webrtc::kDecoderPCMa;
867		*PT=NETEQ_CODEC_PCMA_PT; /* this will be the PT for the sub-headers */
868		*fs=8000;
869        *useRed = 1;
870	} else if(!strcmp(name,"red_isac")){
871		*codec=webrtc::kDecoderISAC;
872		*PT=NETEQ_CODEC_ISAC_PT; /* this will be the PT for the sub-headers */
873		*fs=16000;
874        *useRed = 1;
875    } else {
876		printf("Error: Not a supported codec (%s)\n", name);
877		exit(0);
878	}
879
880}
881
882
883
884
885int NetEQTest_init_coders(webrtc::NetEqDecoder coder, int enc_frameSize, int bitrate, int sampfreq , int vad, int numChannels){
886
887	int ok=0;
888
889    for (int k = 0; k < numChannels; k++)
890    {
891        ok=WebRtcVad_Create(&VAD_inst[k]);
892        if (ok!=0) {
893            printf("Error: Couldn't allocate memory for VAD instance\n");
894            exit(0);
895        }
896        ok=WebRtcVad_Init(VAD_inst[k]);
897        if (ok==-1) {
898            printf("Error: Initialization of VAD struct failed\n");
899            exit(0);
900        }
901
902
903#if (defined(CODEC_CNGCODEC8) || defined(CODEC_CNGCODEC16) || \
904    defined(CODEC_CNGCODEC32) || defined(CODEC_CNGCODEC48))
905        ok=WebRtcCng_CreateEnc(&CNGenc_inst[k]);
906        if (ok!=0) {
907            printf("Error: Couldn't allocate memory for CNG encoding instance\n");
908            exit(0);
909        }
910        if(sampfreq <= 16000) {
911            ok=WebRtcCng_InitEnc(CNGenc_inst[k],sampfreq, 200, 5);
912            if (ok==-1) {
913                printf("Error: Initialization of CNG struct failed. Error code %d\n",
914                    WebRtcCng_GetErrorCodeEnc(CNGenc_inst[k]));
915                exit(0);
916            }
917        }
918#endif
919
920        switch (coder) {
921#ifdef CODEC_PCM16B
922    case webrtc::kDecoderPCM16B :
923#endif
924#ifdef CODEC_PCM16B_WB
925    case webrtc::kDecoderPCM16Bwb :
926#endif
927#ifdef CODEC_PCM16B_32KHZ
928    case webrtc::kDecoderPCM16Bswb32kHz :
929#endif
930#ifdef CODEC_PCM16B_48KHZ
931    case webrtc::kDecoderPCM16Bswb48kHz :
932#endif
933#ifdef CODEC_G711
934    case webrtc::kDecoderPCMu :
935    case webrtc::kDecoderPCMa :
936#endif
937        // do nothing
938        break;
939#ifdef CODEC_G729
940    case webrtc::kDecoderG729:
941        if (sampfreq==8000) {
942            if ((enc_frameSize==80)||(enc_frameSize==160)||(enc_frameSize==240)||(enc_frameSize==320)||(enc_frameSize==400)||(enc_frameSize==480)) {
943                ok=WebRtcG729_CreateEnc(&G729enc_inst[k]);
944                if (ok!=0) {
945                    printf("Error: Couldn't allocate memory for G729 encoding instance\n");
946                    exit(0);
947                }
948            } else {
949                printf("\nError: g729 only supports 10, 20, 30, 40, 50 or 60 ms!!\n\n");
950                exit(0);
951            }
952            WebRtcG729_EncoderInit(G729enc_inst[k], vad);
953            if ((vad==1)&&(enc_frameSize!=80)) {
954                printf("\nError - This simulation only supports VAD for G729 at 10ms packets (not %dms)\n", (enc_frameSize>>3));
955            }
956        } else {
957            printf("\nError - g729 is only developed for 8kHz \n");
958            exit(0);
959        }
960        break;
961#endif
962#ifdef CODEC_G729_1
963    case webrtc::kDecoderG729_1:
964        if (sampfreq==16000) {
965            if ((enc_frameSize==320)||(enc_frameSize==640)||(enc_frameSize==960)
966                ) {
967                    ok=WebRtcG7291_Create(&G729_1_inst[k]);
968                    if (ok!=0) {
969                        printf("Error: Couldn't allocate memory for G.729.1 codec instance\n");
970                        exit(0);
971                    }
972                } else {
973                    printf("\nError: G.729.1 only supports 20, 40 or 60 ms!!\n\n");
974                    exit(0);
975                }
976                if (!(((bitrate >= 12000) && (bitrate <= 32000) && (bitrate%2000 == 0)) || (bitrate == 8000))) {
977                    /* must be 8, 12, 14, 16, 18, 20, 22, 24, 26, 28, 30, or 32 kbps */
978                    printf("\nError: G.729.1 bitrate must be 8000 or 12000--32000 in steps of 2000 bps\n");
979                    exit(0);
980                }
981                WebRtcG7291_EncoderInit(G729_1_inst[k], bitrate, 0 /* flag8kHz*/, 0 /*flagG729mode*/);
982        } else {
983            printf("\nError - G.729.1 input is always 16 kHz \n");
984            exit(0);
985        }
986        break;
987#endif
988#ifdef CODEC_SPEEX_8
989    case webrtc::kDecoderSPEEX_8 :
990        if (sampfreq==8000) {
991            if ((enc_frameSize==160)||(enc_frameSize==320)||(enc_frameSize==480)) {
992                ok=WebRtcSpeex_CreateEnc(&SPEEX8enc_inst[k], sampfreq);
993                if (ok!=0) {
994                    printf("Error: Couldn't allocate memory for Speex encoding instance\n");
995                    exit(0);
996                }
997            } else {
998                printf("\nError: Speex only supports 20, 40, and 60 ms!!\n\n");
999                exit(0);
1000            }
1001            if ((vad==1)&&(enc_frameSize!=160)) {
1002                printf("\nError - This simulation only supports VAD for Speex at 20ms packets (not %dms)\n", (enc_frameSize>>3));
1003                vad=0;
1004            }
1005            ok=WebRtcSpeex_EncoderInit(SPEEX8enc_inst[k], 0/*vbr*/, 3 /*complexity*/, vad);
1006            if (ok!=0) exit(0);
1007        } else {
1008            printf("\nError - Speex8 called with sample frequency other than 8 kHz.\n\n");
1009        }
1010        break;
1011#endif
1012#ifdef CODEC_SPEEX_16
1013    case webrtc::kDecoderSPEEX_16 :
1014        if (sampfreq==16000) {
1015            if ((enc_frameSize==320)||(enc_frameSize==640)||(enc_frameSize==960)) {
1016                ok=WebRtcSpeex_CreateEnc(&SPEEX16enc_inst[k], sampfreq);
1017                if (ok!=0) {
1018                    printf("Error: Couldn't allocate memory for Speex encoding instance\n");
1019                    exit(0);
1020                }
1021            } else {
1022                printf("\nError: Speex only supports 20, 40, and 60 ms!!\n\n");
1023                exit(0);
1024            }
1025            if ((vad==1)&&(enc_frameSize!=320)) {
1026                printf("\nError - This simulation only supports VAD for Speex at 20ms packets (not %dms)\n", (enc_frameSize>>4));
1027                vad=0;
1028            }
1029            ok=WebRtcSpeex_EncoderInit(SPEEX16enc_inst[k], 0/*vbr*/, 3 /*complexity*/, vad);
1030            if (ok!=0) exit(0);
1031        } else {
1032            printf("\nError - Speex16 called with sample frequency other than 16 kHz.\n\n");
1033        }
1034        break;
1035#endif
1036#ifdef CODEC_CELT_32
1037    case webrtc::kDecoderCELT_32 :
1038        if (sampfreq==32000) {
1039            if (enc_frameSize==320) {
1040                ok=WebRtcCelt_CreateEnc(&CELT32enc_inst[k], 1 /*mono*/);
1041                if (ok!=0) {
1042                    printf("Error: Couldn't allocate memory for Celt encoding instance\n");
1043                    exit(0);
1044                }
1045            } else {
1046                printf("\nError: Celt only supports 10 ms!!\n\n");
1047                exit(0);
1048            }
1049            ok=WebRtcCelt_EncoderInit(CELT32enc_inst[k],  1 /*mono*/, 48000 /*bitrate*/);
1050            if (ok!=0) exit(0);
1051        } else {
1052          printf("\nError - Celt32 called with sample frequency other than 32 kHz.\n\n");
1053        }
1054        break;
1055#endif
1056
1057#ifdef CODEC_G722_1_16
1058    case webrtc::kDecoderG722_1_16 :
1059        if (sampfreq==16000) {
1060            ok=WebRtcG7221_CreateEnc16(&G722_1_16enc_inst[k]);
1061            if (ok!=0) {
1062                printf("Error: Couldn't allocate memory for G.722.1 instance\n");
1063                exit(0);
1064            }
1065            if (enc_frameSize==320) {
1066            } else {
1067                printf("\nError: G722.1 only supports 20 ms!!\n\n");
1068                exit(0);
1069            }
1070            WebRtcG7221_EncoderInit16((G722_1_16_encinst_t*)G722_1_16enc_inst[k]);
1071        } else {
1072            printf("\nError - G722.1 is only developed for 16kHz \n");
1073            exit(0);
1074        }
1075        break;
1076#endif
1077#ifdef CODEC_G722_1_24
1078    case webrtc::kDecoderG722_1_24 :
1079        if (sampfreq==16000) {
1080            ok=WebRtcG7221_CreateEnc24(&G722_1_24enc_inst[k]);
1081            if (ok!=0) {
1082                printf("Error: Couldn't allocate memory for G.722.1 instance\n");
1083                exit(0);
1084            }
1085            if (enc_frameSize==320) {
1086            } else {
1087                printf("\nError: G722.1 only supports 20 ms!!\n\n");
1088                exit(0);
1089            }
1090            WebRtcG7221_EncoderInit24((G722_1_24_encinst_t*)G722_1_24enc_inst[k]);
1091        } else {
1092            printf("\nError - G722.1 is only developed for 16kHz \n");
1093            exit(0);
1094        }
1095        break;
1096#endif
1097#ifdef CODEC_G722_1_32
1098    case webrtc::kDecoderG722_1_32 :
1099        if (sampfreq==16000) {
1100            ok=WebRtcG7221_CreateEnc32(&G722_1_32enc_inst[k]);
1101            if (ok!=0) {
1102                printf("Error: Couldn't allocate memory for G.722.1 instance\n");
1103                exit(0);
1104            }
1105            if (enc_frameSize==320) {
1106            } else {
1107                printf("\nError: G722.1 only supports 20 ms!!\n\n");
1108                exit(0);
1109            }
1110            WebRtcG7221_EncoderInit32((G722_1_32_encinst_t*)G722_1_32enc_inst[k]);
1111        } else {
1112            printf("\nError - G722.1 is only developed for 16kHz \n");
1113            exit(0);
1114        }
1115        break;
1116#endif
1117#ifdef CODEC_G722_1C_24
1118    case webrtc::kDecoderG722_1C_24 :
1119        if (sampfreq==32000) {
1120            ok=WebRtcG7221C_CreateEnc24(&G722_1C_24enc_inst[k]);
1121            if (ok!=0) {
1122                printf("Error: Couldn't allocate memory for G.722.1C instance\n");
1123                exit(0);
1124            }
1125            if (enc_frameSize==640) {
1126            } else {
1127                printf("\nError: G722.1 C only supports 20 ms!!\n\n");
1128                exit(0);
1129            }
1130            WebRtcG7221C_EncoderInit24((G722_1C_24_encinst_t*)G722_1C_24enc_inst[k]);
1131        } else {
1132            printf("\nError - G722.1 C is only developed for 32kHz \n");
1133            exit(0);
1134        }
1135        break;
1136#endif
1137#ifdef CODEC_G722_1C_32
1138    case webrtc::kDecoderG722_1C_32 :
1139        if (sampfreq==32000) {
1140            ok=WebRtcG7221C_CreateEnc32(&G722_1C_32enc_inst[k]);
1141            if (ok!=0) {
1142                printf("Error: Couldn't allocate memory for G.722.1C instance\n");
1143                exit(0);
1144            }
1145            if (enc_frameSize==640) {
1146            } else {
1147                printf("\nError: G722.1 C only supports 20 ms!!\n\n");
1148                exit(0);
1149            }
1150            WebRtcG7221C_EncoderInit32((G722_1C_32_encinst_t*)G722_1C_32enc_inst[k]);
1151        } else {
1152            printf("\nError - G722.1 C is only developed for 32kHz \n");
1153            exit(0);
1154        }
1155        break;
1156#endif
1157#ifdef CODEC_G722_1C_48
1158    case webrtc::kDecoderG722_1C_48 :
1159        if (sampfreq==32000) {
1160            ok=WebRtcG7221C_CreateEnc48(&G722_1C_48enc_inst[k]);
1161            if (ok!=0) {
1162                printf("Error: Couldn't allocate memory for G.722.1C instance\n");
1163                exit(0);
1164            }
1165            if (enc_frameSize==640) {
1166            } else {
1167                printf("\nError: G722.1 C only supports 20 ms!!\n\n");
1168                exit(0);
1169            }
1170            WebRtcG7221C_EncoderInit48((G722_1C_48_encinst_t*)G722_1C_48enc_inst[k]);
1171        } else {
1172            printf("\nError - G722.1 C is only developed for 32kHz \n");
1173            exit(0);
1174        }
1175        break;
1176#endif
1177#ifdef CODEC_G722
1178    case webrtc::kDecoderG722 :
1179        if (sampfreq==16000) {
1180            if (enc_frameSize%2==0) {
1181            } else {
1182                printf("\nError - g722 frames must have an even number of enc_frameSize\n");
1183                exit(0);
1184            }
1185            WebRtcG722_CreateEncoder(&g722EncState[k]);
1186            WebRtcG722_EncoderInit(g722EncState[k]);
1187        } else {
1188            printf("\nError - g722 is only developed for 16kHz \n");
1189            exit(0);
1190        }
1191        break;
1192#endif
1193#ifdef CODEC_AMR
1194    case webrtc::kDecoderAMR :
1195        if (sampfreq==8000) {
1196            ok=WebRtcAmr_CreateEnc(&AMRenc_inst[k]);
1197            if (ok!=0) {
1198                printf("Error: Couldn't allocate memory for AMR encoding instance\n");
1199                exit(0);
1200            }if ((enc_frameSize==160)||(enc_frameSize==320)||(enc_frameSize==480)) {
1201            } else {
1202                printf("\nError - AMR must have a multiple of 160 enc_frameSize\n");
1203                exit(0);
1204            }
1205            WebRtcAmr_EncoderInit(AMRenc_inst[k], vad);
1206            WebRtcAmr_EncodeBitmode(AMRenc_inst[k], AMRBandwidthEfficient);
1207            AMR_bitrate = bitrate;
1208        } else {
1209            printf("\nError - AMR is only developed for 8kHz \n");
1210            exit(0);
1211        }
1212        break;
1213#endif
1214#ifdef CODEC_AMRWB
1215    case webrtc::kDecoderAMRWB :
1216        if (sampfreq==16000) {
1217            ok=WebRtcAmrWb_CreateEnc(&AMRWBenc_inst[k]);
1218            if (ok!=0) {
1219                printf("Error: Couldn't allocate memory for AMRWB encoding instance\n");
1220                exit(0);
1221            }
1222            if (((enc_frameSize/320)<0)||((enc_frameSize/320)>3)||((enc_frameSize%320)!=0)) {
1223                printf("\nError - AMRwb must have frameSize of 20, 40 or 60ms\n");
1224                exit(0);
1225            }
1226            WebRtcAmrWb_EncoderInit(AMRWBenc_inst[k], vad);
1227            if (bitrate==7000) {
1228                AMRWB_bitrate = AMRWB_MODE_7k;
1229            } else if (bitrate==9000) {
1230                AMRWB_bitrate = AMRWB_MODE_9k;
1231            } else if (bitrate==12000) {
1232                AMRWB_bitrate = AMRWB_MODE_12k;
1233            } else if (bitrate==14000) {
1234                AMRWB_bitrate = AMRWB_MODE_14k;
1235            } else if (bitrate==16000) {
1236                AMRWB_bitrate = AMRWB_MODE_16k;
1237            } else if (bitrate==18000) {
1238                AMRWB_bitrate = AMRWB_MODE_18k;
1239            } else if (bitrate==20000) {
1240                AMRWB_bitrate = AMRWB_MODE_20k;
1241            } else if (bitrate==23000) {
1242                AMRWB_bitrate = AMRWB_MODE_23k;
1243            } else if (bitrate==24000) {
1244                AMRWB_bitrate = AMRWB_MODE_24k;
1245            }
1246            WebRtcAmrWb_EncodeBitmode(AMRWBenc_inst[k], AMRBandwidthEfficient);
1247
1248        } else {
1249            printf("\nError - AMRwb is only developed for 16kHz \n");
1250            exit(0);
1251        }
1252        break;
1253#endif
1254#ifdef CODEC_ILBC
1255    case webrtc::kDecoderILBC :
1256        if (sampfreq==8000) {
1257            ok=WebRtcIlbcfix_EncoderCreate(&iLBCenc_inst[k]);
1258            if (ok!=0) {
1259                printf("Error: Couldn't allocate memory for iLBC encoding instance\n");
1260                exit(0);
1261            }
1262            if ((enc_frameSize==160)||(enc_frameSize==240)||(enc_frameSize==320)||(enc_frameSize==480)) {
1263            } else {
1264                printf("\nError - iLBC only supports 160, 240, 320 and 480 enc_frameSize (20, 30, 40 and 60 ms)\n");
1265                exit(0);
1266            }
1267            if ((enc_frameSize==160)||(enc_frameSize==320)) {
1268                /* 20 ms version */
1269                WebRtcIlbcfix_EncoderInit(iLBCenc_inst[k], 20);
1270            } else {
1271                /* 30 ms version */
1272                WebRtcIlbcfix_EncoderInit(iLBCenc_inst[k], 30);
1273            }
1274        } else {
1275            printf("\nError - iLBC is only developed for 8kHz \n");
1276            exit(0);
1277        }
1278        break;
1279#endif
1280#ifdef CODEC_ISAC
1281    case webrtc::kDecoderISAC:
1282        if (sampfreq==16000) {
1283            ok=WebRtcIsac_Create(&ISAC_inst[k]);
1284            if (ok!=0) {
1285                printf("Error: Couldn't allocate memory for iSAC instance\n");
1286                exit(0);
1287            }if ((enc_frameSize==480)||(enc_frameSize==960)) {
1288            } else {
1289                printf("\nError - iSAC only supports frameSize (30 and 60 ms)\n");
1290                exit(0);
1291            }
1292            WebRtcIsac_EncoderInit(ISAC_inst[k],1);
1293            if ((bitrate<10000)||(bitrate>32000)) {
1294                printf("\nError - iSAC bitrate has to be between 10000 and 32000 bps (not %i)\n", bitrate);
1295                exit(0);
1296            }
1297            WebRtcIsac_Control(ISAC_inst[k], bitrate, enc_frameSize>>4);
1298        } else {
1299            printf("\nError - iSAC only supports 480 or 960 enc_frameSize (30 or 60 ms)\n");
1300            exit(0);
1301        }
1302        break;
1303#endif
1304#ifdef NETEQ_ISACFIX_CODEC
1305    case webrtc::kDecoderISAC:
1306        if (sampfreq==16000) {
1307            ok=WebRtcIsacfix_Create(&ISAC_inst[k]);
1308            if (ok!=0) {
1309                printf("Error: Couldn't allocate memory for iSAC instance\n");
1310                exit(0);
1311            }if ((enc_frameSize==480)||(enc_frameSize==960)) {
1312            } else {
1313                printf("\nError - iSAC only supports frameSize (30 and 60 ms)\n");
1314                exit(0);
1315            }
1316            WebRtcIsacfix_EncoderInit(ISAC_inst[k],1);
1317            if ((bitrate<10000)||(bitrate>32000)) {
1318                printf("\nError - iSAC bitrate has to be between 10000 and 32000 bps (not %i)\n", bitrate);
1319                exit(0);
1320            }
1321            WebRtcIsacfix_Control(ISAC_inst[k], bitrate, enc_frameSize>>4);
1322        } else {
1323            printf("\nError - iSAC only supports 480 or 960 enc_frameSize (30 or 60 ms)\n");
1324            exit(0);
1325        }
1326        break;
1327#endif
1328#ifdef CODEC_ISAC_SWB
1329    case webrtc::kDecoderISACswb:
1330        if (sampfreq==32000) {
1331            ok=WebRtcIsac_Create(&ISACSWB_inst[k]);
1332            if (ok!=0) {
1333                printf("Error: Couldn't allocate memory for iSAC SWB instance\n");
1334                exit(0);
1335            }if (enc_frameSize==960) {
1336            } else {
1337                printf("\nError - iSAC SWB only supports frameSize 30 ms\n");
1338                exit(0);
1339            }
1340            ok = WebRtcIsac_SetEncSampRate(ISACSWB_inst[k], 32000);
1341            if (ok!=0) {
1342                printf("Error: Couldn't set sample rate for iSAC SWB instance\n");
1343                exit(0);
1344            }
1345            WebRtcIsac_EncoderInit(ISACSWB_inst[k],1);
1346            if ((bitrate<32000)||(bitrate>56000)) {
1347                printf("\nError - iSAC SWB bitrate has to be between 32000 and 56000 bps (not %i)\n", bitrate);
1348                exit(0);
1349            }
1350            WebRtcIsac_Control(ISACSWB_inst[k], bitrate, enc_frameSize>>5);
1351        } else {
1352            printf("\nError - iSAC SWB only supports 960 enc_frameSize (30 ms)\n");
1353            exit(0);
1354        }
1355        break;
1356#endif
1357#ifdef CODEC_GSMFR
1358    case webrtc::kDecoderGSMFR:
1359        if (sampfreq==8000) {
1360            ok=WebRtcGSMFR_CreateEnc(&GSMFRenc_inst[k]);
1361            if (ok!=0) {
1362                printf("Error: Couldn't allocate memory for GSM FR encoding instance\n");
1363                exit(0);
1364            }
1365            if ((enc_frameSize==160)||(enc_frameSize==320)||(enc_frameSize==480)) {
1366            } else {
1367                printf("\nError - GSM FR must have a multiple of 160 enc_frameSize\n");
1368                exit(0);
1369            }
1370            WebRtcGSMFR_EncoderInit(GSMFRenc_inst[k], 0);
1371        } else {
1372            printf("\nError - GSM FR is only developed for 8kHz \n");
1373            exit(0);
1374        }
1375        break;
1376#endif
1377    default :
1378        printf("Error: unknown codec in call to NetEQTest_init_coders.\n");
1379        exit(0);
1380        break;
1381        }
1382
1383        if (ok != 0) {
1384            return(ok);
1385        }
1386    }  // end for
1387
1388    return(0);
1389}
1390
1391
1392
1393
1394int NetEQTest_free_coders(webrtc::NetEqDecoder coder, int numChannels) {
1395
1396    for (int k = 0; k < numChannels; k++)
1397    {
1398        WebRtcVad_Free(VAD_inst[k]);
1399#if (defined(CODEC_CNGCODEC8) || defined(CODEC_CNGCODEC16) || \
1400    defined(CODEC_CNGCODEC32) || defined(CODEC_CNGCODEC48))
1401        WebRtcCng_FreeEnc(CNGenc_inst[k]);
1402#endif
1403
1404        switch (coder)
1405        {
1406#ifdef CODEC_PCM16B
1407        case webrtc::kDecoderPCM16B :
1408#endif
1409#ifdef CODEC_PCM16B_WB
1410        case webrtc::kDecoderPCM16Bwb :
1411#endif
1412#ifdef CODEC_PCM16B_32KHZ
1413        case webrtc::kDecoderPCM16Bswb32kHz :
1414#endif
1415#ifdef CODEC_PCM16B_48KHZ
1416        case webrtc::kDecoderPCM16Bswb48kHz :
1417#endif
1418#ifdef CODEC_G711
1419        case webrtc::kDecoderPCMu :
1420        case webrtc::kDecoderPCMa :
1421#endif
1422            // do nothing
1423            break;
1424#ifdef CODEC_G729
1425        case webrtc::kDecoderG729:
1426            WebRtcG729_FreeEnc(G729enc_inst[k]);
1427            break;
1428#endif
1429#ifdef CODEC_G729_1
1430        case webrtc::kDecoderG729_1:
1431            WebRtcG7291_Free(G729_1_inst[k]);
1432            break;
1433#endif
1434#ifdef CODEC_SPEEX_8
1435        case webrtc::kDecoderSPEEX_8 :
1436            WebRtcSpeex_FreeEnc(SPEEX8enc_inst[k]);
1437            break;
1438#endif
1439#ifdef CODEC_SPEEX_16
1440        case webrtc::kDecoderSPEEX_16 :
1441            WebRtcSpeex_FreeEnc(SPEEX16enc_inst[k]);
1442            break;
1443#endif
1444#ifdef CODEC_CELT_32
1445        case webrtc::kDecoderCELT_32 :
1446            WebRtcCelt_FreeEnc(CELT32enc_inst[k]);
1447            break;
1448#endif
1449
1450#ifdef CODEC_G722_1_16
1451        case webrtc::kDecoderG722_1_16 :
1452            WebRtcG7221_FreeEnc16(G722_1_16enc_inst[k]);
1453            break;
1454#endif
1455#ifdef CODEC_G722_1_24
1456        case webrtc::kDecoderG722_1_24 :
1457            WebRtcG7221_FreeEnc24(G722_1_24enc_inst[k]);
1458            break;
1459#endif
1460#ifdef CODEC_G722_1_32
1461        case webrtc::kDecoderG722_1_32 :
1462            WebRtcG7221_FreeEnc32(G722_1_32enc_inst[k]);
1463            break;
1464#endif
1465#ifdef CODEC_G722_1C_24
1466        case webrtc::kDecoderG722_1C_24 :
1467            WebRtcG7221C_FreeEnc24(G722_1C_24enc_inst[k]);
1468            break;
1469#endif
1470#ifdef CODEC_G722_1C_32
1471        case webrtc::kDecoderG722_1C_32 :
1472            WebRtcG7221C_FreeEnc32(G722_1C_32enc_inst[k]);
1473            break;
1474#endif
1475#ifdef CODEC_G722_1C_48
1476        case webrtc::kDecoderG722_1C_48 :
1477            WebRtcG7221C_FreeEnc48(G722_1C_48enc_inst[k]);
1478            break;
1479#endif
1480#ifdef CODEC_G722
1481        case webrtc::kDecoderG722 :
1482            WebRtcG722_FreeEncoder(g722EncState[k]);
1483            break;
1484#endif
1485#ifdef CODEC_AMR
1486        case webrtc::kDecoderAMR :
1487            WebRtcAmr_FreeEnc(AMRenc_inst[k]);
1488            break;
1489#endif
1490#ifdef CODEC_AMRWB
1491        case webrtc::kDecoderAMRWB :
1492            WebRtcAmrWb_FreeEnc(AMRWBenc_inst[k]);
1493            break;
1494#endif
1495#ifdef CODEC_ILBC
1496        case webrtc::kDecoderILBC :
1497            WebRtcIlbcfix_EncoderFree(iLBCenc_inst[k]);
1498            break;
1499#endif
1500#ifdef CODEC_ISAC
1501        case webrtc::kDecoderISAC:
1502            WebRtcIsac_Free(ISAC_inst[k]);
1503            break;
1504#endif
1505#ifdef NETEQ_ISACFIX_CODEC
1506        case webrtc::kDecoderISAC:
1507            WebRtcIsacfix_Free(ISAC_inst[k]);
1508            break;
1509#endif
1510#ifdef CODEC_ISAC_SWB
1511        case webrtc::kDecoderISACswb:
1512            WebRtcIsac_Free(ISACSWB_inst[k]);
1513            break;
1514#endif
1515#ifdef CODEC_GSMFR
1516        case webrtc::kDecoderGSMFR:
1517            WebRtcGSMFR_FreeEnc(GSMFRenc_inst[k]);
1518            break;
1519#endif
1520        default :
1521            printf("Error: unknown codec in call to NetEQTest_init_coders.\n");
1522            exit(0);
1523            break;
1524        }
1525    }
1526
1527	return(0);
1528}
1529
1530
1531
1532
1533
1534
1535int NetEQTest_encode(int coder, int16_t *indata, int frameLen, unsigned char * encoded,int sampleRate ,
1536						  int * vad, int useVAD, int bitrate, int numChannels){
1537
1538	short cdlen = 0;
1539	int16_t *tempdata;
1540	static int first_cng=1;
1541	int16_t tempLen;
1542
1543	*vad =1;
1544
1545    // check VAD first
1546	if(useVAD)
1547    {
1548        *vad = 0;
1549
1550        for (int k = 0; k < numChannels; k++)
1551        {
1552            tempLen = frameLen;
1553            tempdata = &indata[k*frameLen];
1554            int localVad=0;
1555            /* Partition the signal and test each chunk for VAD.
1556            All chunks must be VAD=0 to produce a total VAD=0. */
1557            while (tempLen >= 10*sampleRate/1000) {
1558                if ((tempLen % 30*sampleRate/1000) == 0) { // tempLen is multiple of 30ms
1559                    localVad |= WebRtcVad_Process(VAD_inst[k] ,sampleRate, tempdata, 30*sampleRate/1000);
1560                    tempdata += 30*sampleRate/1000;
1561                    tempLen -= 30*sampleRate/1000;
1562                }
1563                else if (tempLen >= 20*sampleRate/1000) { // tempLen >= 20ms
1564                    localVad |= WebRtcVad_Process(VAD_inst[k] ,sampleRate, tempdata, 20*sampleRate/1000);
1565                    tempdata += 20*sampleRate/1000;
1566                    tempLen -= 20*sampleRate/1000;
1567                }
1568                else { // use 10ms
1569                    localVad |= WebRtcVad_Process(VAD_inst[k] ,sampleRate, tempdata, 10*sampleRate/1000);
1570                    tempdata += 10*sampleRate/1000;
1571                    tempLen -= 10*sampleRate/1000;
1572                }
1573            }
1574
1575            // aggregate all VAD decisions over all channels
1576            *vad |= localVad;
1577        }
1578
1579        if(!*vad){
1580            // all channels are silent
1581            cdlen = 0;
1582            for (int k = 0; k < numChannels; k++)
1583            {
1584                WebRtcCng_Encode(CNGenc_inst[k],&indata[k*frameLen], (frameLen <= 640 ? frameLen : 640) /* max 640 */,
1585                    encoded,&tempLen,first_cng);
1586                encoded += tempLen;
1587                cdlen += tempLen;
1588            }
1589            *vad=0;
1590            first_cng=0;
1591            return(cdlen);
1592        }
1593	}
1594
1595
1596    // loop over all channels
1597    int totalLen = 0;
1598
1599    for (int k = 0; k < numChannels; k++)
1600    {
1601        /* Encode with the selected coder type */
1602        if (coder==webrtc::kDecoderPCMu) { /*g711 u-law */
1603#ifdef CODEC_G711
1604            cdlen = WebRtcG711_EncodeU(G711state[k], indata, frameLen, (int16_t*) encoded);
1605#endif
1606        }
1607        else if (coder==webrtc::kDecoderPCMa) { /*g711 A-law */
1608#ifdef CODEC_G711
1609            cdlen = WebRtcG711_EncodeA(G711state[k], indata, frameLen, (int16_t*) encoded);
1610        }
1611#endif
1612#ifdef CODEC_PCM16B
1613        else if ((coder==webrtc::kDecoderPCM16B)||(coder==webrtc::kDecoderPCM16Bwb)||
1614            (coder==webrtc::kDecoderPCM16Bswb32kHz)||(coder==webrtc::kDecoderPCM16Bswb48kHz)) { /*pcm16b (8kHz, 16kHz, 32kHz or 48kHz) */
1615                cdlen = WebRtcPcm16b_EncodeW16(indata, frameLen, (int16_t*) encoded);
1616            }
1617#endif
1618#ifdef CODEC_G722
1619        else if (coder==webrtc::kDecoderG722) { /*g722 */
1620            cdlen=WebRtcG722_Encode(g722EncState[k], indata, frameLen, (int16_t*)encoded);
1621            assert(cdlen == frameLen>>1);
1622        }
1623#endif
1624#ifdef CODEC_ILBC
1625        else if (coder==webrtc::kDecoderILBC) { /*iLBC */
1626            cdlen=WebRtcIlbcfix_Encode(iLBCenc_inst[k], indata,frameLen,(int16_t*)encoded);
1627        }
1628#endif
1629#if (defined(CODEC_ISAC) || defined(NETEQ_ISACFIX_CODEC)) // TODO(hlundin): remove all NETEQ_ISACFIX_CODEC
1630        else if (coder==webrtc::kDecoderISAC) { /*iSAC */
1631            int noOfCalls=0;
1632            cdlen=0;
1633            while (cdlen<=0) {
1634#ifdef CODEC_ISAC /* floating point */
1635                cdlen = WebRtcIsac_Encode(ISAC_inst[k],
1636                                          &indata[noOfCalls * 160],
1637                                          encoded);
1638#else /* fixed point */
1639                cdlen = WebRtcIsacfix_Encode(ISAC_inst[k],
1640                                             &indata[noOfCalls * 160],
1641                                             encoded);
1642#endif
1643                noOfCalls++;
1644            }
1645        }
1646#endif
1647#ifdef CODEC_ISAC_SWB
1648        else if (coder==webrtc::kDecoderISACswb) { /* iSAC SWB */
1649            int noOfCalls=0;
1650            cdlen=0;
1651            while (cdlen<=0) {
1652                cdlen = WebRtcIsac_Encode(ISACSWB_inst[k],
1653                                          &indata[noOfCalls * 320],
1654                                          encoded);
1655                noOfCalls++;
1656            }
1657        }
1658#endif
1659#ifdef CODEC_CELT_32
1660        else if (coder==webrtc::kDecoderCELT_32) { /* Celt */
1661            int encodedLen = 0;
1662            cdlen = 0;
1663            while (cdlen <= 0) {
1664                cdlen = WebRtcCelt_Encode(CELT32enc_inst[k], &indata[encodedLen], encoded);
1665                encodedLen += 10*32; /* 10 ms */
1666            }
1667            if( (encodedLen != frameLen) || cdlen < 0) {
1668                printf("Error encoding Celt frame!\n");
1669                exit(0);
1670            }
1671        }
1672#endif
1673
1674        indata += frameLen;
1675        encoded += cdlen;
1676        totalLen += cdlen;
1677
1678    }  // end for
1679
1680	first_cng=1;
1681	return(totalLen);
1682}
1683
1684
1685
1686void makeRTPheader(unsigned char* rtp_data, int payloadType, int seqNo, uint32_t timestamp, uint32_t ssrc){
1687
1688			rtp_data[0]=(unsigned char)0x80;
1689			rtp_data[1]=(unsigned char)(payloadType & 0xFF);
1690			rtp_data[2]=(unsigned char)((seqNo>>8)&0xFF);
1691			rtp_data[3]=(unsigned char)((seqNo)&0xFF);
1692			rtp_data[4]=(unsigned char)((timestamp>>24)&0xFF);
1693			rtp_data[5]=(unsigned char)((timestamp>>16)&0xFF);
1694
1695			rtp_data[6]=(unsigned char)((timestamp>>8)&0xFF);
1696			rtp_data[7]=(unsigned char)(timestamp & 0xFF);
1697
1698			rtp_data[8]=(unsigned char)((ssrc>>24)&0xFF);
1699			rtp_data[9]=(unsigned char)((ssrc>>16)&0xFF);
1700
1701			rtp_data[10]=(unsigned char)((ssrc>>8)&0xFF);
1702			rtp_data[11]=(unsigned char)(ssrc & 0xFF);
1703}
1704
1705
1706int makeRedundantHeader(unsigned char* rtp_data, int *payloadType, int numPayloads, uint32_t *timestamp, uint16_t *blockLen,
1707                        int seqNo, uint32_t ssrc)
1708{
1709
1710    int i;
1711    unsigned char *rtpPointer;
1712    uint16_t offset;
1713
1714    /* first create "standard" RTP header */
1715    makeRTPheader(rtp_data, NETEQ_CODEC_RED_PT, seqNo, timestamp[numPayloads-1], ssrc);
1716
1717    rtpPointer = &rtp_data[12];
1718
1719    /* add one sub-header for each redundant payload (not the primary) */
1720    for(i=0; i<numPayloads-1; i++) {                                            /* |0 1 2 3 4 5 6 7| */
1721        if(blockLen[i] > 0) {
1722            offset = (uint16_t) (timestamp[numPayloads-1] - timestamp[i]);
1723
1724            rtpPointer[0] = (unsigned char) ( 0x80 | (0x7F & payloadType[i]) ); /* |F|   block PT  | */
1725            rtpPointer[1] = (unsigned char) ((offset >> 6) & 0xFF);             /* |  timestamp-   | */
1726            rtpPointer[2] = (unsigned char) ( ((offset & 0x3F)<<2) |
1727                ( (blockLen[i]>>8) & 0x03 ) );                                  /* | -offset   |bl-| */
1728            rtpPointer[3] = (unsigned char) ( blockLen[i] & 0xFF );             /* | -ock length   | */
1729
1730            rtpPointer += 4;
1731        }
1732    }
1733
1734    /* last sub-header */
1735    rtpPointer[0]= (unsigned char) (0x00 | (0x7F&payloadType[numPayloads-1]));/* |F|   block PT  | */
1736    rtpPointer += 1;
1737
1738    return(rtpPointer - rtp_data); /* length of header in bytes */
1739}
1740
1741
1742
1743int makeDTMFpayload(unsigned char* payload_data, int Event, int End, int Volume, int Duration) {
1744	unsigned char E,R,V;
1745	R=0;
1746	V=(unsigned char)Volume;
1747	if (End==0) {
1748		E = 0x00;
1749	} else {
1750		E = 0x80;
1751	}
1752	payload_data[0]=(unsigned char)Event;
1753	payload_data[1]=(unsigned char)(E|R|V);
1754	//Duration equals 8 times time_ms, default is 8000 Hz.
1755	payload_data[2]=(unsigned char)((Duration>>8)&0xFF);
1756	payload_data[3]=(unsigned char)(Duration&0xFF);
1757	return(4);
1758}
1759
1760void stereoDeInterleave(int16_t* audioSamples, int numSamples)
1761{
1762
1763    int16_t *tempVec;
1764    int16_t *readPtr, *writeL, *writeR;
1765
1766    if (numSamples <= 0)
1767        return;
1768
1769    tempVec = (int16_t *) malloc(sizeof(int16_t) * numSamples);
1770    if (tempVec == NULL) {
1771        printf("Error allocating memory\n");
1772        exit(0);
1773    }
1774
1775    memcpy(tempVec, audioSamples, numSamples*sizeof(int16_t));
1776
1777    writeL = audioSamples;
1778    writeR = &audioSamples[numSamples/2];
1779    readPtr = tempVec;
1780
1781    for (int k = 0; k < numSamples; k += 2)
1782    {
1783        *writeL = *readPtr;
1784        readPtr++;
1785        *writeR = *readPtr;
1786        readPtr++;
1787        writeL++;
1788        writeR++;
1789    }
1790
1791    free(tempVec);
1792
1793}
1794
1795
1796void stereoInterleave(unsigned char* data, int dataLen, int stride)
1797{
1798
1799    unsigned char *ptrL, *ptrR;
1800    unsigned char temp[10];
1801
1802    if (stride > 10)
1803    {
1804        exit(0);
1805    }
1806
1807    if (dataLen%1 != 0)
1808    {
1809        // must be even number of samples
1810        printf("Error: cannot interleave odd sample number\n");
1811        exit(0);
1812    }
1813
1814    ptrL = data + stride;
1815    ptrR = &data[dataLen/2];
1816
1817    while (ptrL < ptrR) {
1818        // copy from right pointer to temp
1819        memcpy(temp, ptrR, stride);
1820
1821        // shift data between pointers
1822        memmove(ptrL + stride, ptrL, ptrR - ptrL);
1823
1824        // copy from temp to left pointer
1825        memcpy(ptrL, temp, stride);
1826
1827        // advance pointers
1828        ptrL += stride*2;
1829        ptrR += stride;
1830    }
1831
1832}
1833