New post-filter A(z/g1)/A(z/g2)
[speexdsp.git] / libspeex / testenc_wb.c
1 #include "speex.h"
2 #include <stdio.h>
3 #include <stdlib.h>
4
5 #define FRAME_SIZE 320
6 #include <math.h>
7 int main(int argc, char **argv)
8 {
9    char *inFile, *outFile, *bitsFile;
10    FILE *fin, *fout, *fbits=NULL;
11    short in[FRAME_SIZE];
12    float input[FRAME_SIZE], bak[FRAME_SIZE], bak2[FRAME_SIZE];
13    char cbits[200];
14    int nbBits;
15    int i;
16    void *st;
17    void *dec;
18    SpeexBits bits;
19    int pf;
20
21    for (i=0;i<FRAME_SIZE;i++)
22       bak2[i]=0;
23    st = speex_encoder_init(&speex_wb_mode);
24    dec = speex_decoder_init(&speex_wb_mode);
25
26    pf=1;
27    speex_decoder_ctl(dec, SPEEX_SET_PF, &pf);
28
29    if (argc != 4 && argc != 3)
30    {
31       fprintf (stderr, "Usage: encode [in file] [out file] [bits file]\nargc = %d", argc);
32       exit(1);
33    }
34    inFile = argv[1];
35    fin = fopen(inFile, "r");
36    outFile = argv[2];
37    fout = fopen(outFile, "w");
38    if (argc==4)
39    {
40       bitsFile = argv[3];
41       fbits = fopen(bitsFile, "w");
42    }
43    speex_bits_init(&bits);
44    while (!feof(fin))
45    {
46       fread(in, sizeof(short), FRAME_SIZE, fin);
47       if (feof(fin))
48          break;
49       for (i=0;i<FRAME_SIZE;i++)
50          bak[i]=input[i]=in[i];
51       speex_bits_reset(&bits);
52       speex_encode(st, input, &bits);
53       nbBits = speex_bits_write(&bits, cbits, 200);
54       printf ("Encoding frame in %d bits\n", nbBits*8);
55       if (argc==4)
56          fwrite(cbits, 1, nbBits, fbits);
57       {
58          float enoise=0, esig=0, snr;
59          for (i=0;i<FRAME_SIZE;i++)
60          {
61             enoise+=(bak2[i]-input[i])*(bak2[i]-input[i]);
62             esig += bak2[i]*bak2[i];
63          }
64          snr = 10*log10((esig+1)/(enoise+1));
65          printf ("real SNR = %f\n", snr);
66       }
67       speex_bits_rewind(&bits);
68       
69       speex_decode(dec, &bits, input, 0);
70
71       /* Save the bits here */
72       for (i=0;i<FRAME_SIZE;i++)
73       {
74          if (input[i]>32000)
75             input[i]=32000;
76          else if (input[i]<-32000)
77             input[i]=-32000;
78       }
79       speex_bits_reset(&bits);
80       for (i=0;i<FRAME_SIZE;i++)
81          in[i]=input[i];
82       for (i=0;i<FRAME_SIZE;i++)
83          bak2[i]=bak[i];
84       fwrite(in, sizeof(short), FRAME_SIZE, fout);
85    }
86    
87    speex_encoder_destroy(st);
88    speex_decoder_destroy(dec);
89    return 1;
90 }