able/windows-nt
1
0
Fork 0
Code Issues Pull requests Projects Releases Wiki Activity
windows-nt/Source/XPSP1/NT/enduser/netmeeting/av/codecs/lh/encoder.c

1626 lines
47 KiB
C
Raw Normal View History

Add source files
2020-09-26 03:20:57 -05:00
/*#define __TEST
#ifdef __TEST
#include <stdio.h>
FILE *test;
FILE *codage;
#endif*/
/*
* Project: Direct Subband 16000 bps coder and SBCELP 4800 bps coder
* Workfile: encoder.c
* Author: Alfred Wiesen
* Created: 30 August 1995
* Last update: 4 September 1995
* DLL Version: 1.00
* Revision: Single DLL for coder and decoder.
* Comment:
*
* (C) Copyright 1993-95 Lernout & Hauspie Speech Products N.V. (TM)
* All rights reserved. Company confidential.
*/
// ------------------------------------------------------------------------
// ------------------------------------------------------------------------
// Included files
// ------------------------------------------------------------------------
// ------------------------------------------------------------------------
#include <math.h>
#include <windows.h>
#include <windowsx.h>
#include "fv_x8.h"
#include "data.h"
#include "bib_32.h"
// ------------------------------------------------------------------------
// ------------------------------------------------------------------------
// Function prototypes
// ------------------------------------------------------------------------
// ------------------------------------------------------------------------
void InitializeCoderInstanceData(PVOID p, DWORD dwMaxBitRate);
void decimation_I(short input_I[],short coef_I[],short low_part_mem_I[],short order);
#if 0
// PhilF: The following is never called!!!
void quant_0a16_I2(short z1, short z2 ,short vec[], short maxv, short B1[], short B2[], long *code);
#endif
void quant_sous_bandes(PC16008DATA p,short *in,short *codes_max, long *codes_sb, short *indic_br/*, short *code_max_br*/);
void code_res_I(PC16008DATA p,short input[],short coef[],short qmf_mem[],short v_code[],long cod_long[], short ind_br[]/*, short c_max_br*/);
#ifdef CELP4800
void COEFF_A(PC4808DATA p),CALPITCH(PC4808DATA p),CHERCHE(PC4808DATA p);
void PERIODE(PC4808DATA p,short no),FRAME(PC4808DATA p);
void lsp_quant(PC4808DATA p,short lsp[],short nbit[],short bitdi[],short vcode[]);
void cal_dic1(PC4808DATA p,short *y,short *sr,short *espopt,short *posit,short dec,short esp,short sigpit[],short soulong,long tlsp[],long vmax[]);
//void cal_dic2(short q,short espace,short phase,short *s_r,short *hy,short *b,short *vois,short *esp,short *qq,short *phas,short sigpit[],short soulong,long tlsp[],long vmax[]);
void cal_dic2(PC4808DATA p,short q,short espace,short phase,short *s_r,short *hy,short *b,short *vois,short *esp,short *qq,short *phas);
#endif
void decimation(short *vin,short *vout,short nech);
/*void iConvert64To8(int *in, int *out, int N, int *mem);
void iConvert8To64(int *in, int *out, int N, int *mem);
void BandPass(int *,int *,int *,int);*/
// ------------------------------------------------------------------------
// ------------------------------------------------------------------------
// Global variables for coder
// ------------------------------------------------------------------------
// ------------------------------------------------------------------------
/*#define MAXCODINGHANDLES 10
// Instance data structure
PC16008DATA pCoderData;
C16008DATA CoderData[MAXCODINGHANDLES];
int CodingHandles[MAXCODINGHANDLES];*/
// ROM tables :
extern short coef_I[]; // QMF filter coeffs
extern short B3_I[]; // Five levels quantification table
extern short B4_I[]; // Four levels quantification table
extern short B5_I[]; // Five levels quantification table
extern short B6_I[]; // Nine levels quantification table
extern short B7_I[]; // Nine levels quantification table
extern short B8_I[]; // Nine levels quantification table
extern short B9_I[]; // Nine levels quantification table
extern short max_level[]; // Quantified maximum sample level
extern long coeffs[];
extern long Mask[];
extern short hamming[];
extern short A0[];
extern short tabcos[];
extern short LSP_Q[];
extern short TAB_DI[];
extern short GQ[];
extern short GV[];
extern short BQ[];
extern short BV[];
extern short NBB[];
extern short BITDD[];
extern short LSP0ROM[];
//extern short quantif[];
//extern short bits[];
//extern short bytes[];
// RAM variables :
/*extern short codes_max[]; // Quantized max. of each subband
extern long codes_sb[]; // Two codes for each of the quantized subband
extern short indic_sp[]; // type of subband (1=noise; 0=to be decoded)
extern short code_max_br; // 1 bit for coding the noise
extern short DATA_I[]; // Intermediate vector = input and output of QMF
extern char stream[]; // Coded data buffer*/
// ------------------------------------------------------------------------
// ------------------------------------------------------------------------
// Function implementation
// ------------------------------------------------------------------------
// ------------------------------------------------------------------------
// ------------------------------------------------------------------------
void InitializeCoderInstanceData(PVOID p, DWORD dwMaxBitRate)
// Instance data initializations
{
short i;
#ifdef CELP4800
if (dwMaxBitRate == 4800)
{
((PC4808DATA)p)->dwMaxBitRate = dwMaxBitRate;
((PC4808DATA)p)->mem_pit[0]=((PC4808DATA)p)->mem_pit[1]=69;
for (i=0;i<10;i++)
((PC4808DATA)p)->LSP0[i]=LSP0ROM[i];
}
else
#endif
{
((PC16008DATA)p)->dwMaxBitRate = dwMaxBitRate;
for (i=0;i<NBFAC;i++) ((PC16008DATA)p)->nbbit[i]=8; // On met les compteurs a "zero";
// on suppose demarrer par du bruit
((PC16008DATA)p)->MAX_LEVEL = MAX_LEVEL1; // valeur par defaut si le debit n'augmente pas trop
((PC16008DATA)p)->DIV_MAX = DIV_MAX1; // cad on ne traite pas les sb < 5% du max[i]
((PC16008DATA)p)->quantif[0] = 9;
((PC16008DATA)p)->quantif[1] = 9;
((PC16008DATA)p)->quantif[4] = 5;
((PC16008DATA)p)->quantif[5] = 5;
((PC16008DATA)p)->quantif[6] = 5;
((PC16008DATA)p)->quantif[7] = 5;
((PC16008DATA)p)->quantif[8] = 5;
((PC16008DATA)p)->quantif[9] = 5;
((PC16008DATA)p)->bits[0] = 52;
((PC16008DATA)p)->bits[2] = 38;
((PC16008DATA)p)->bits[3] = 38;
((PC16008DATA)p)->bits[4] = 38;
// Bug 3214: Just in case we get carried away, init the end of the arrays in both configurations
((PC16008DATA)p)->quantif[10] = 5;
((PC16008DATA)p)->quantif[11] = 5;
((PC16008DATA)p)->bits[5] = 38;
if (dwMaxBitRate == 16000)
{
((PC16008DATA)p)->NBSB_SP_MAX = NBSB_SP_MAX1_16000; // nbre max de sb pouvant etre du signal
((PC16008DATA)p)->quantif[2] = 7;
((PC16008DATA)p)->quantif[3] = 7;
((PC16008DATA)p)->bits[1] = 46;
}
else
{
((PC16008DATA)p)->NBSB_SP_MAX = NBSB_SP_MAX1_8000_12000; // nbre max de sb pouvant etre du signal
((PC16008DATA)p)->quantif[2] = 9;
((PC16008DATA)p)->quantif[3] = 9;
((PC16008DATA)p)->bits[1] = 52;
}
}
return;
}
//------------------------------------------------------------------------
void decimation_I(short input_I[],short coef_I[],short low_part_mem_I[],short order)
//
// Purpose : from data stored in DATA[], create the N_SB subbands
// Remark : output subband is stored at (input[]+N_SB*L_RES)
//
{
short i,j,lng;
short *low_out_part_I;
short *high_out_part_I;
short *buffer_I,*sa_vec_I;
buffer_I = low_part_mem_I;
for (i=0;i<N_SB;i++)
{
low_out_part_I=input_I+L_RES;
lng = L_RES >> (i+1);
high_out_part_I=low_out_part_I+lng;
sa_vec_I=low_out_part_I;
for (j=0;j<(1<<i);j++)
{
low_part_mem_I=buffer_I;
QMFilter(input_I,coef_I,low_out_part_I,high_out_part_I,low_part_mem_I,lng);
input_I += 2*lng; low_out_part_I += lng; high_out_part_I += lng;
if (j&1) high_out_part_I += 2*lng;
else low_out_part_I += 2*lng;
buffer_I += 2*order;
}
input_I=sa_vec_I;
}
}
#if 0
// PhilF: The following is never called!!!
//------------------------------------------------------------------------
void quant_0a16_I2(short z1, short z2, short vec[], short maxv, short B1[], short B2[], long *code)
// Quantifies the 16 samples of a subband on z levels using the table B[]
// Result stored in code[] (two long codes pro subband).
{
short i,x;
short ftmp;
long result;
result=0;
for (i=0;i<8;i++) // Quantify the first eight samples of the subband
{
ftmp=(((long)vec[i])<<13)/maxv;
x=0;
if (i==2*(short)(i/2))
{
while((ftmp>B1[x])&&(x<z1-1)) x++; result*=z1;
}
else
{
while((ftmp>B2[x])&&(x<z2-1)) x++; result*=z2;
}
result+=x; // Construct long code
}
*code=result; // Store code
result=0;
for (i=0;i<8;i++) // Quantify the last eight samples of the subband
{
ftmp=(((long)vec[i+8])<<13)/maxv;
x=0;
if (i==2*(short)(i/2))
{
while((ftmp>B1[x])&&(x<z1-1)) x++; result*=z1;
}
else
{
while((ftmp>B2[x])&&(x<z2-1)) x++; result*=z2;
}
result+=x; // Construct long code
}
*(code+1)=result; // Store code
}
#endif
void quant_0a16_I3(short z1, short z2, short vec[], short maxv, long *code)
// Quantifies the 16 samples of a subband on z levels using the table B[]
// Result stored in code[] (two long codes pro subband).
{
short i,x;
short ftmp;
long result;
short *B1,*B2;
switch (z1)
{
case 3: B1=B3_I; break;
case 4: B1=B4_I; break;
case 5: B1=B5_I; break;
case 6: B1=B6_I; break;
case 7: B1=B7_I; break;
case 8: B1=B8_I; break;
case 9: B1=B9_I; break;
// Bug 3214: Just in case we're passed a bogus value, set a default quantizer
default: B1=B5_I; break;
}
switch (z2)
{
case 3: B2=B3_I; break;
case 4: B2=B4_I; break;
case 5: B2=B5_I; break;
case 6: B2=B6_I; break;
case 7: B2=B7_I; break;
case 8: B2=B8_I; break;
case 9: B2=B9_I; break;
// Bug 3214: Just in case we're passed a bogus value, set a default quantizer
default: B2=B5_I; break;
}
result=0;
for (i=0;i<8;i++) // Quantify the first eight samples of the subband
{
ftmp=(((long)vec[i])<<13)/maxv;
x=0;
if (i==2*(short)(i/2))
{
while((ftmp>B1[x])&&(x<z1-1)) x++; result*=z1;
}
else
{
while((ftmp>B2[x])&&(x<z2-1)) x++; result*=z2;
}
result+=x; // Construct long code
}
*code=result; // Store code
result=0;
for (i=0;i<8;i++) // Quantify the last eight samples of the subband
{
ftmp=(((long)vec[i+8])<<13)/maxv;
x=0;
if (i==2*(short)(i/2))
{
while((ftmp>B1[x])&&(x<z1-1)) x++; result*=z1;
}
else
{
while((ftmp>B2[x])&&(x<z2-1)) x++; result*=z2;
}
result+=x; // Construct long code
}
*(code+1)=result; // Store code
}
//------------------------------------------------------------------------
void quant_sous_bandes(PC16008DATA p,short *in,short *codes_max, long *codes_sb, short *indic_sp)
// Quantifies the eight subbands
{
short max[8];
short order[8]={0,0,0,0,0,0,0,0};
short codes_max_loc[8]={0,0,0,0,0,0,0,0};
short maximum,max_num,ord,maxmax;
short i,j;
#ifdef MAX_SB_ABSOLU
short sb_count;
#endif
for (i=0;i<8;i++) // Quantify the maximums of the subbands
{
max[i]=0;
for (j=0;j<16;j++)
if (abs(*(in+16*i+j))>max[i]) max[i]=abs(*(in+16*i+j));
}
for (i=0;i<8;i++)
{
if (max[i]>2*max_level[31]) j = 31;
else for (j=0; max[i]>2*max_level[j]; j++);
codes_max_loc[i]=j;
max[i]=2*max_level[j];
} // fin quantifiation
p->nbbit_cf+=8; // 8 bits for the indic_sp
maxmax=0;
for (i=0;i<8;i++) // On cherche le plus grand maximum
{
if (max[i]>maxmax) maxmax=max[i];
}
maxmax/=p->DIV_MAX; // On le divise par 10 a 20 (cad a peu pres 10 a 5 %)
ord=8;
p->nbsb_sp=0;
for (i=0;i<8;i++) // Calculates the order of the subbands
{ // 1 is higher energy than 2 than 3,..
maximum=32767;
for (j=7;j>=0;j--)
{
if ((order[j]==0)&&(max[j]<maximum))
{
max_num=j; maximum=max[j];
}
}
order[max_num]=ord;
if ( (ord>p->NBSB_SP_MAX)||(maximum<=p->MAX_LEVEL)||(maximum<=maxmax) )
{
indic_sp[max_num]=0; // c'est 1 bande qui sera du bruit
}
else
{
indic_sp[max_num]=1;
p->nbsb_sp++;
}
ord--;
}
j=0;
for (i=0;i<8;i++)
{
if (indic_sp[i]==1)
{
codes_max[j]=codes_max_loc[i]; //5* 4 ou 5 bits suffisent
j++;
p->nbbit_cf+=5; // 5 bits per coded max
}
}
for (i=p->nbsb_sp-1;i>=0;i--)
{
j=0;
while (order[j]!=i+1) j++;
quant_0a16_I3(p->quantif[2*i],p->quantif[2*i+1],in+j*16,max[j],codes_sb+2*i);
p->nbbit_cf+=p->bits[i];
}
if (p->dwMaxBitRate == 16000)
{
j=0;
#ifdef MAX_SB_ABSOLU
sb_count=p->nbsb_sp;
if (sb_count>=MAX_SB_ABSOLU) return;
#endif
for (i=0;i<8;i++)
{
if (indic_sp[i]==0)
{
codes_max[p->nbsb_sp+j]=codes_max_loc[i]; //5* 4 ou 5 bits suffisent
j++;
p->nbbit_cf+=5; // 5 bits per coded max
#ifdef MAX_SB_ABSOLU
sb_count++;
quant_0a16_I3(SILENCE_QUANT_LEVEL_16000,SILENCE_QUANT_LEVEL_16000,in+i*16,max[i],codes_sb+2*sb_count);
p->nbbit_cf+=SILENCE_CODING_BIT_16000;
if (sb_count>=MAX_SB_ABSOLU) break;
#endif
}
}
#ifndef MAX_SB_ABSOLU
for (i=7;i>=p->nbsb_sp;i--)
{
j=0;
while (order[j]!=i+1) j++;
quant_0a16_I3(SILENCE_QUANT_LEVEL_16000,SILENCE_QUANT_LEVEL_16000,in+j*16,max[j],codes_sb+2*i);
p->nbbit_cf+=SILENCE_CODING_BIT_16000;
}
#endif
}
}
//------------------------------------------------------------------------
void code_res_I(PC16008DATA p,short input[],short coef[],short qmf_mem[],short v_code[],long cod_long[], short ind_br[]/*, short c_max_br*/)
{
decimation_I(input,coef,qmf_mem,Fil_Lenght);
quant_sous_bandes(p,input+3*L_RES,v_code,cod_long,ind_br/*AW,&c_max_br*/);
}
//------------------------------------------------------------------------
short Multiplexing(
char *Stream,
long *Codes,
short *CodeSizes,
short NumCodes,
short StreamSize)
{
short B,P; // B=bits <20> coder, P=bits libres
short i,j;
#ifdef __CHECK_FORMAT
long TotalBytes=0;
for (i=0;i<NumCodes;i++) TotalBytes+=CodeSizes[i];
if (TotalBytes>StreamSize*8) return 1;
#endif
i=0;
j=0;
B=CodeSizes[i]; // bits <20> coder
P=8; // 1 octet libre au d<>part
Stream[j]=0;
while (i<NumCodes)
{
if (P>B)
{
Stream[j]|=(Codes[i]&Mask[B])<<(P-B);
P-=B;
i++;
B=CodeSizes[i];
}
else if (P<B)
{
Stream[j]|=(Codes[i]>>(B-P))&Mask[P];
B-=P;
P=8;
j++;
Stream[j]=0;
}
else
{
Stream[j]|=Codes[i]&Mask[P];
i++;
j++;
P=8;
B=CodeSizes[i];
Stream[j]=0;
}
}
return 0;
}
// ------------------------------------------------------------------------
#ifdef CELP4800
void iteration(PC4808DATA p,long *P,short n,short *s)
{
short i;
p->a=0x7fffffffL;
for(i=0;i<7 ;i++)
{
horner(P,p->ttt,&p->a,n,*s);
horner(p->ttt,p->TLSP+12,&p->b,(short)(n-1),*s);
*s += calcul_s(p->a,p->b);
}
horner(P,p->ttt,&p->a,n,*s);
*(P+n) = 0;
long_to_long(p->ttt,P,n);
}
// ------------------------------------------------------------------------
void ai_to_lsp(PC4808DATA p,long *ai_pq,short *lsp)
{
short s; short n;
ai_to_pq(ai_pq,10);
s=0x7fff;
p->ptr1 = lsp;
for(n=5; n>2; n--)
{
iteration(p,ai_pq,n,&s);
*p->ptr1++ = s;
if (lsp[0]<0) lsp[0]=s=32765;
iteration(p,ai_pq+6,n,&s);
*p->ptr1++ = s;
}
binome(lsp+6,ai_pq);
}
// ------------------------------------------------------------------------
void cal_dic1(PC4808DATA p,short *y,short *sr,short *espopt,short *posit,short dec,short esp,
short *sigpi,short soulong,long *tlsp,long *vmax)
{
short i,k,limite;
long *vene;
vene = (long *)(sigpi+150);
venergy(y,vene,soulong);
k=soulong-1;
for (i=0;i<dec;i++)
{
p->ptr1 = sr;limite=i;
*tlsp = *(p->ptr1+limite); limite += esp;
while (limite<soulong) { *tlsp += *(p->ptr1+limite); limite += esp;}
*(tlsp+1) = *(vene+k-i);
limite=upd_max_d(tlsp,vmax);
if (limite) {*posit=i; *espopt=esp; *posit=i; *espopt=esp;}
}
}
// ------------------------------------------------------------------------
void cal_dic2(PC4808DATA p,short q,short espace,short phase,short *s_r,short *hy,
short *b,short *vois,short *esp,short *qq,short *phas)
{
short i,j,i0,k;
short src[10],*y2; short cc[10];
long R11;
y2 = p->SIGPI+75;
R11 = 0;
init_zero(y2,p->SOULONG);
for (j=0;j<q;j++)
{
i0=espace*j+phase;
src[j]=s_r[i0];
}
for (j=0;j<q;j++) if (src[j]>0) cc[j]=1;
else cc[j]=-1;
for (i=0;i<q;i++) R11 += abs(src[i]);
for (j=0;j<q;j++)
{
i0=espace*j+phase;
k=cc[j];
if (k>0)
{
add_sf_vect(y2,hy,i0,p->SOULONG);
}
else
{
sub_sf_vect(y2,hy,i0,p->SOULONG);
}
}
energy2(y2,p->TLSP+1,p->SOULONG);
*p->TLSP=R11;
i = upd_max_d(p->TLSP,p->VMAX);
if (i) { short_to_short(cc,b,q); *vois=0; *esp=espace; *qq=q; *phas=phase; }
/* for (i=0;i<q;i++)
{
cc[i]=-cc[i];
*TLSP = R11 + 2*src[i]*cc[i];
k=2*cc[i];
i0=espace*i+phase;
update_dic(y1,y2,hy,SOULONG,i0,k);
energy2(y1,TLSP+1,SOULONG);
k = upd_max_d(TLSP,VMAX);
if (k)
{
short_to_short(cc,b,q);
R11 = *TLSP;
my2=y1; y1=y2; y2=my2;
*vois=0; *esp=espace; *qq=q; *phas=phase;
}
else cc[i]=-cc[i];
}*/
}
/*-------------------------------------------------------------------------
Review version of CAL_DIC2
{
R11 = 0;
init_zero(y2,SOULONG);
i0=phase-espace;
for (j=0;j<q;j++)
{
i0+=espace;
src[j]=s_r[i0];
if (src[j]>0)
{
cc[j]=1;
R11 += (long)(src[j]);
add_sf_vect(y2,hy,i0,SOULONG);
}
else
{
cc[j]=-1;
R11 -= (long)(src[j]);
sub_sf_vect(y2,hy,i0,SOULONG);
}
}
energy2(y2,TLSP+1,SOULONG);
*TLSP=R11;
i = upd_max_d(TLSP,VMAX);
if (i) { short_to_short(cc,b,q); *vois=0; *esp=espace; *qq=q; *phas=phase; }
i0=phase-espace;
for (i=0;i<q;i++)
{
cc[i]=-cc[i];
*TLSP = R11 + 2*src[i]*cc[i];
k=2*cc[i];
i0+=espace;
update_dic(y1,y2,hy,SOULONG,i0,k);
energy2(y1,TLSP+1,SOULONG);
k = upd_max_d(TLSP,VMAX);
if (k)
{
short_to_short(cc,b,q);
R11 = *TLSP;
my2=y1; y1=y2; y2=my2;
*vois=0; *esp=espace; *qq=q; *phas=phase;
}
else cc[i]=-cc[i];
}
}
-----------------------------------------------------------------------*/
// ------------------------------------------------------------------------
void left_correl(PC4808DATA p,short vech[],short debut,short fin,short pitch,short delta,long *vv)
{
short i,k,lng;
lng=fin-debut+1;
i=pitch-delta;
energy(vech+debut-i,p->TLSP+2,lng);
correlation(vech+debut-i,vech+debut,p->TLSP,lng);
norm_corrl(vv,p->TLSP);
for (i=pitch-delta+1;i<=pitch+delta;i++)
{
correlation(vech+debut-i,vech+debut,p->TLSP,lng);
p->TLSP[10] = (long)vech[debut-i]*(long)vech[debut-i];
p->TLSP[11] = (long)vech[fin-i+1]*(long)vech[fin-i+1];
upd_ene(p->TLSP+2,p->TLSP+10);
k=i-pitch+delta;
norm_corrl(vv+2*k,p->TLSP);
}
}
// ------------------------------------------------------------------------
void right_correl(PC4808DATA p,short vech[],short debut,short fin,short pitch,short delta,long *vv)
{
short i,k,lng;
lng=fin-debut+1;
i=pitch-delta;
energy(vech+debut+i,p->TLSP+2,lng);
correlation(vech+debut+i,vech+debut,p->TLSP,lng);
norm_corrr(vv,p->TLSP);
for (i=pitch-delta+1;i<=pitch+delta;i++)
{
correlation(vech+debut+i,vech+debut,p->TLSP,lng);
p->TLSP[11]=(long)vech[debut+i-1]*(long)vech[debut+i-1];
p->TLSP[10]=(long)vech[fin+i]*(long)vech[fin+i];
upd_ene(p->TLSP+2,p->TLSP+10);
k=i-pitch+delta;
norm_corrr(vv+2*k,p->TLSP);
}
}
// ------------------------------------------------------------------------
void COEFF_A(PC4808DATA p)
{
fenetre(p->SIG+SOUDECAL1-RECS2,hamming,p->SIGPI,NECHFEN);
autocor(p->SIGPI,p->TLSP,NECHFEN,NETAGES);
// TLSP[0]=ldiv(TLSP[0]*1001L,1000L);
if (*p->TLSP)
{
schur(p->LSP,p->TLSP,NETAGES);
ki_to_ai(p->LSP,p->TLSP,NETAGES);
ai_to_lsp(p,p->TLSP,p->LSP);
cos_to_teta(tabcos,p->LSP,10);
}
else short_to_short(p->LSP0,p->LSP,10);
lsp_quant(p,p->LSP,NBB,BITDD,p->code);
short_to_short(p->LSP,p->A3,10);
teta_to_cos(tabcos,p->A3,10);
lsp_to_ai(p->A3,p->TLSP,10);
interpol(p->LSP0,p->LSP,p->A1,NETAGES);
teta_to_cos(tabcos,p->A1,10);
lsp_to_ai(p->A1,p->TLSP,10);
interpol(p->LSP,p->LSP0,p->A2,NETAGES);
teta_to_cos(tabcos,p->A2,10);
lsp_to_ai(p->A2,p->TLSP,10);
short_to_short(p->LSP,p->LSP0,NETAGES);
}
// ------------------------------------------------------------------------
void lsp_quant(PC4808DATA p,short lsp[],short nbit[],short bitdi[],short vcode[])
{
short i,iopt,k,nombi,m,m1,k2;
short *delta,*lsptab,dmin,tmp,demi;
delta = p->E;
lsptab = LSP_Q;
m1 = NETAGES/2;
for (i=0;i<nbit[0];i++) delta[i]=abs(lsp[0] - *(lsptab+i) );
dmin=delta[0];
iopt=0;
for (i=1;i<nbit[0];i++)
if (delta[i]<dmin)
{
dmin=delta[i];
iopt=i;
}
lsp[0] = *(lsptab+iopt);
vcode[0]=iopt;
for (k=1;k<m1;k++)
{
k2=2*k;
lsptab += nbit[k-1];
for (i=0;i<nbit[k];i++) delta[i]=abs(lsp[k2] - *(lsptab+i));
dmin=32767;
tmp=lsp[k2-1];
if (tmp<lsp[k2-2]) tmp=lsp[k2-2];
for (i=0;i<nbit[k];i++)
if (*(lsptab+i)>tmp)
if (delta[i]<dmin)
{
dmin=delta[i];
iopt=i;
}
lsp[k2] = *(lsptab+iopt);
vcode[k2] = iopt;
}
lsptab = TAB_DI;
for (k=0; k<m1-1; k++)
{
k2 = k<<1;
m=bitdi[k];
nombi = (m-1)<<1;
demi=(lsp[k2+2]-lsp[k2]+1)>>1;
for (i=0;i<m;i++)
delta[i]=lsp[k2] + (short)(((long)*(lsptab++)* (long)demi+(long)16384<<1)>>16);
for (i=0;i<m-2;i++) delta[m+i]=lsp[k2+2] - (short)(((long)*(lsptab++) * (long)demi+(long)16384<<1)>>16);
dmin=32767;
for (i=0;i<nombi;i++)
{
tmp = abs(lsp[k2+1]-delta[i]);
if (tmp<dmin)
{
iopt=i;
dmin=tmp;
}
}
lsp[k2+1]=delta[iopt];
vcode[k2+1]=iopt;
}
m=bitdi[k];
nombi=(m-1)<<1;
demi=(32767-lsp[8]+1)>>1;
for (i=0;i<m;i++) delta[i] = lsp[8] + (short)(((long)*(lsptab++) * (long)demi+(long)16384<<1)>>16);
dmin=32767;
for (i=0;i<nombi;i++)
{
tmp = abs(lsp[9]-delta[i]);
if (tmp<dmin)
{
iopt=i;
dmin=tmp;
}
}
lsp[9]=delta[iopt];
vcode[9]=iopt;
}
// ------------------------------------------------------------------------
void RESIDU(PC4808DATA p,short no)
{
short i0;
switch (no)
{
case 0:
i0=0;
break;
case 1: short_to_short(p->A2,p->A1,11);
i0=SOUDECAL1;
break;
case 2: short_to_short(p->A3,p->A1,11);
i0=SOUDECAL1+SOUDECAL;
break;
}
f_inverse(p->MINV,p->A1,p->SIG+i0,p->E,p->SOULONG,NETAGES);
}
// ------------------------------------------------------------------------
void PERIODE(PC4808DATA p,short no)
{
short i,P1,P2;
short *y0,*y1,*y2;
short MAX,MAX2,j,bit_garde;
y0=p->SIGPI; y2=y0+75; y1=p->E_PE;
fenetre(p->A1,A0,p->Aw,11);
init_zero(p->zz,12);
p->H[0]=4096;
init_zero(p->H+1,(short)(p->SOULONG-1));
synthesis(p->zz,p->Aw,p->H,p->H,35,NETAGES,0);
if (no)
{
P1=p->PITCH-3;
if (P1<LIM_P1) P1=LIM_P1;
P2=p->PITCH+4;
if (P2>LIM_P2) P2=LIM_P2;
}
else
{
P1=p->PITCH-5;
if (P1<LIM_P1) P1=LIM_P1;
P2=p->PITCH+5;
if (P2>LIM_P2) P2=LIM_P2;
}
// calc_p(&P1,&P2,PITCH,LIM_P1,LIM_P2,no);
MAX = max_vect(p->E,p->SOULONG);
if (P2<p->SOULONG) MAX2 = max_vect(p->EE+lngEE-P2,P2);
else
{
if (P1<p->SOULONG) j=P1+16;
else j=p->SOULONG+16;
MAX2 = max_vect(p->EE+lngEE-P2,j);
}
if (MAX2>MAX) MAX=MAX2;
if (MAX & 0xe000)
{
i=MAX >> 13;
if (!(i>>1)) bit_garde=1;
else bit_garde=2;
}
else bit_garde=0;
init_zero(p->zz,12);
synthesis(p->zz,p->Aw,p->E,y1,p->SOULONG,NETAGES,bit_garde);
if (P1<p->SOULONG)
{
short_to_short(p->EE+lngEE-P1,y0,P1);
for (i=P1;i<p->SOULONG;i++) y0[i]=0;
}
else short_to_short(p->EE+lngEE-P1,y0,p->SOULONG);
init_zero(p->zz,12);
synthesis(p->zz,p->Aw,y0,y0,p->SOULONG,NETAGES,bit_garde);
short_to_short(y0,y2,p->SOULONG);
if (P1<p->SOULONG) add_sf_vect(y2,y0,P1,p->SOULONG);
if (2*P1<p->SOULONG) add_sf_vect(y2,y0,(short)(P1<<1),p->SOULONG);
energy(y2,p->TLSP+2,p->SOULONG);
correlation(y1,y2,p->TLSP,p->SOULONG);
p->VMAX[1]=-6969;
p->VMAX[4]=P1;
upd_max(p->TLSP,p->VMAX,P1);
for (i=P1+1;i<=P2;i++)
{
p->ptr1=y0; y0=y2; y2=p->ptr1;
update_ltp(y0,y2,p->H+1,p->SOULONG,bit_garde,p->EE[lngEE-i]);
if (i<p->SOULONG)
{
short_to_short(y0,y2,p->SOULONG);
add_sf_vect(y2,y0,i,p->SOULONG);
if (2*i<p->SOULONG) add_sf_vect(y2,y0,(short)(i<<1),p->SOULONG);
energy(y2,p->TLSP+2,p->SOULONG);
correlation(y1,y2,p->TLSP,p->SOULONG);
}
else
{
energy(y0,p->TLSP+2,p->SOULONG);
correlation(y1,y0,p->TLSP,p->SOULONG);
}
upd_max(p->TLSP,p->VMAX,i);
}
#if 0
//*(p->VMAX+2) = 28265821L;
//*(p->VMAX+3) = 61L;
//*(p->VMAX+2) = 881427L;
//*(p->VMAX+3) = 1L;
//*(p->VMAX+2) = 9851363L;
//*(p->VMAX+3) = 6L;
//*(p->VMAX+2) = 812881L;
//*(p->VMAX+3) = 2L;
#if 1
// Save jmp
if ((*(p->VMAX+2) < 0L) || (*(p->VMAX+3) == 0L) || (((long)((long)(*(p->VMAX+2))/(long)(*(p->VMAX+3))) & 0xFFFC0000) == 0L))
proc_gain(p->VMAX+2,p->ttt);
else
*(p->ttt) = 0L; // *(p->VMAX+3) = 0L;
#else
if ((*(p->VMAX+2) > 0L) && (*(p->VMAX+3)) && ((long)((long)(*(p->VMAX+2))/(long)(*(p->VMAX+3))) & 0x0FFC0000))
{
*(p->ttt) = 0L; // *(p->VMAX+3) = 0L;
}
else
proc_gain(p->VMAX+2,p->ttt);
#endif
#else
//*(p->VMAX+2) = 28265821L;
//*(p->VMAX+3) = 61L;
//*(p->VMAX+2) = 881427L;
//*(p->VMAX+3) = 1L;
//*(p->VMAX+2) = 9851363L;
//*(p->VMAX+3) = 6L;
//*(p->VMAX+2) = 812881L;
//*(p->VMAX+3) = 2L;
proc_gain(p->VMAX+2,p->ttt);
#endif
p->PITCH=(short)p->VMAX[4];
/*
if (ttt[0]>32767) GLTP=32767;
else
if (ttt[0]<-32767) GLTP=-32767;
else GLTP=ttt[0];
m = abs(GLTP);
for (i=1;i<=10;i++) if ((m>=BQ[i-1])&&(m<BQ[i]))
{
if (GLTP>0) { GLTP=BV[i] ; k=i-1; }
else { GLTP=-BV[i]; k=i+10-1; }
break;
}
if (GLTP>=BQ[10]) { GLTP=BV[10]; k=9; }
if (GLTP<-BQ[6]) { GLTP=-BV[6]; k=15 ; }
*/
p->code[11+p->depl]=calc_gltp(&p->GLTP,BQ,BV,p->ttt[0]);;
p->code[10+p->depl]=p->PITCH;
if (p->PITCH<p->SOULONG)
{
short_to_short(p->EE+lngEE-p->PITCH,p->E_PE,p->PITCH);
short_to_short(p->E_PE,p->E_PE+p->PITCH,(short)(p->SOULONG-p->PITCH));
mult_fact(p->E_PE,p->E_PE,p->GLTP,p->SOULONG);
}
else
{
mult_fact(p->EE+lngEE-p->PITCH,p->E_PE,p->GLTP,p->SOULONG);
}
}
// ------------------------------------------------------------------------
void CHERCHE(PC4808DATA p)
{
short i;
short position,esp_opt;
short k,j;
short c[10],VOISE,npopt,phas_opt,cod,sign;
short Gopt;
short *sr,*y0;
short MAX,bit_garde;
sr=p->SIGPI; y0=sr+75;
for (i=0;i<p->SOULONG;i++) p->E[i] -= p->E_PE[i];
init_zero(p->zz,12);
synthesis(p->zz,p->Aw,p->E,sr,p->SOULONG,NETAGES,0);
MAX = max_vect(sr,p->SOULONG);
/* if (MAX & 0xfe00)
{
i=MAX >> 9;
if (!(i>>1)) bit_garde=1;
else if (!(i>>2)) bit_garde=2;
else if (!(i>>3)) bit_garde=3;
else if (!(i>>4)) bit_garde=4;
else if (!(i>>5)) bit_garde=5;
else bit_garde=6;
}
else bit_garde=0;
*/
bit_garde=calc_garde(MAX);
inver_v_int(sr,y0,p->SOULONG);
init_zero(p->zz,12);
synthesis(p->zz,p->Aw,y0,y0,p->SOULONG,NETAGES,bit_garde);
inver_v_int(y0,sr,p->SOULONG);
p->VMAX[0]=-6969;
Gopt=position=0;
VOISE=1;
if ( !p->UNVOIS )
{
esp_opt=p->PITCH;
short_to_short(p->H,y0,p->SOULONG);
if (p->PITCH<p->SOULONG) add_sf_vect(y0,p->H,p->PITCH,p->SOULONG);
// cal_dic1(y0,sr,&esp_opt,&position,SOULONG,PITCH);
cal_dic1(p,y0,sr,&esp_opt,&position,p->SOULONG,p->PITCH,p->SIGPI,p->SOULONG,p->TLSP,p->VMAX);
/* if (PITCH>=SOULONG)
{
if (PITCH/2<SOULONG) sign = PITCH/2;
else sign=PITCH/3;
short_to_short(H,y0,SOULONG);
add_sf_vect(y0,H,sign,SOULONG);
// cal_dic1(y0,sr,&esp_opt,&position,54,sign);
cal_dic1(y0,sr,&esp_opt,&position,54,sign,SIGPI,SOULONG,TLSP,VMAX);
}
// else cal_dic1(H,sr,&esp_opt,&position,54,SOULONG+5);
else cal_dic1(H,sr,&esp_opt,&position,54,SOULONG+5,SIGPI,SOULONG,TLSP,VMAX);
*/
}
cal_dic2(p,8,7,0,sr,p->H,c,&VOISE,&esp_opt,&npopt,&phas_opt);
cal_dic2(p,7,8,3,sr,p->H,c,&VOISE,&esp_opt,&npopt,&phas_opt);
/*
cal_dic2(8,7,0,sr,H,c,&VOISE,&esp_opt,&npopt,&phas_opt,SIGPI,SOULONG,TLSP,VMAX);
cal_dic2(7,8,3,sr,H,c,&VOISE,&esp_opt,&npopt,&phas_opt,SIGPI,SOULONG,TLSP,VMAX);
*/
proc_gain2(p->VMAX+1,p->VMAX,bit_garde);
if (p->VMAX[0]>32767) Gopt=32767;
else if (p->VMAX[0]<-32767) Gopt=-32767;
else Gopt=(short)p->VMAX[0];
if (VOISE==0)
{
if (c[0]==-1)
{
Gopt=-Gopt;
for (k=0;k<npopt;k++) c[k]=-c[k];
}
if (npopt==7) cod = 64;
else cod = 128;
for (j=1;j<npopt;j++)
if (c[j]==1) cod += 1 << (npopt-j-1);
}
else
{
if (esp_opt == p->PITCH) cod=position;
else cod = position+SOUDECAL1;
}
p->code[12+p->depl]=cod;
if (Gopt<0) { Gopt=-Gopt; sign=1; }
else sign=0;
for (i=1;i<=16;i++) if ((Gopt>=GQ[i-1])&&(Gopt<GQ[i]))
{
Gopt=GV[i];
cod=i-1;
break;
}
if (Gopt>=GQ[16]) { Gopt=GV[16]; cod=15; }
if (sign) { Gopt = -Gopt; cod += 16; }
p->code[13+p->depl]=cod;
// Gopt=calc_gopt(c,code,GQ,GV,VOISE,npopt,PITCH,esp_opt,depl,position,SOUDECAL1,VMAX[0]);
short_to_short(p->E_PE,p->E,p->SOULONG);
if (VOISE==1)
{
i=0;
do
{
p->E[position+i] += Gopt;
i += esp_opt;
}
while ((position+i)<p->SOULONG);
}
else
for (j=0;j<npopt;j++)
p->E[esp_opt*j+phas_opt] += c[j]*Gopt;
short_to_short(p->EE+p->SOULONG,p->EE,(short)(lngEE-p->SOULONG));
short_to_short(p->E,p->EE+lngEE-p->SOULONG,p->SOULONG);
}
// ------------------------------------------------------------------------
void FRAME(PC4808DATA p)
// Purpose : concatenate all parameters
// Input parameter :
// code[] : parameters code
// Output parameter :
// output_stream[] : multiplexed code
//
// Comments: The LTP or Adaptive codebook is also called PITCH.
//
// Bit allocation : Codebook or gain "i" is the codebook for suboutput_stream "i".
// code[0] = LSP(0) : 3bits code[10] = LTP codebook 1 : 7bits
// code[1] = LSP(1) : 4bits code[11] = LTP gain 1 : 4bits
// code[2] = LSP(2) : 4bits code[12] = Binary codebook 1 : 8bits
// code[3] = LSP(3) : 3bits code[13] = Binary gain 1 : 5bits
// code[4] = LSP(4) : 4bits code[14] = LTP codebook 2 : 4bits
// code[5] = LSP(5) : 3bits code[15] = LTP gain 2 : 4bits
// code[6] = LSP(6) : 3bits code[16] = Binary codebook 2 : 8bits
// code[7] = LSP(7) : 2bits code[17] = Binary gain 2 : 5bits
// code[8] = LSP(8) : 3bits code[18] = LTP codebook 3 : 4bits
// code[9] = LSP(9) : 1bits code[19] = LTP gain 3 : 4bits
// code[20] = Binary codebook 3 : 8bits
// code[21] = Binary gain 3 : 5bits
//
// output_stream[0] = LSP[0] | LSP[1] | LSP[2] | (Binary gain 2)
// output_stream[1] = LSP[3] | (Binary gain 3) | (Binary codebook 1)
// output_stream[2] = LSP[4] | LSP[5] | LSP[6] | LSP[7] | LSP[8] | LSP[9]
// output_stream[3] = (LTP codebook 1) | (LTP gain 1) | (Binary gain 1)
// output_stream[4] = (LTP codebook 2) | (LTP gain 2) | (Binary codebook 2)
// output_stream[5] = (LTP codebook 3) | (LTP gain 3) | (Binary codebook 3)
{
p->code[18] = p->code[18]-p->code[14]+7;
p->code[14] = p->code[14]-p->code[10]+7;
p->code[10] -= LIM_P1;
p->output_frame[0] = (p->code[0]<<13) | (p->code[1]<<9) | (p->code[2]<<5) | p->code[17];
p->output_frame[1] = (p->code[3]<<13) | (p->code[21]<<8) | p->code[12];
p->output_frame[2] = (p->code[4]<<12) | (p->code[5]<<9) | (p->code[6]<<6) | (p->code[7]<<4) | (p->code[8]<<1) | p->code[9];
p->output_frame[3] = (p->code[10]<<9) | (p->code[11]<<5) | p->code[13];
p->output_frame[4] = (p->code[14]<<12) | (p->code[15]<<8) | p->code[16];
p->output_frame[5] = (p->code[18]<<12) | (p->code[19]<<8) | p->code[20];
/*
code[18] = code[18]-code[14]+3;
code[14] = code[14]-code[10]+3;
code[10] -= LIM_P1;
output_frame[0] = (code[0]<<13) | (code[1]<<9) | code[12];
output_frame[1] = (code[3]<<13) | (code[2]<<9) | code[16];
output_frame[2] = (code[5]<<13) | (code[4]<<9) | code[20];
output_frame[3] = (code[10]<<9) | (code[6]<<6) | (code[14]<<3) | code[18];
output_frame[4] = (code[11]<<12) | (code[15]<<8) | (code[19]<<4) | (code[7]<<2) | code[8];
output_frame[5] = (code[13]<<11) | (code[17]<<6) | (code[21]<<1) | code[9];
*/
}
// ------------------------------------------------------------------------
void CALPITCH(PC4808DATA p)
{
short P1,P2,P3,j0,j1,L;
/* long GG;
GG=0;
for (j=0;j<NECHFEN;j++) GG += (long)abs(SIG[SOUDECAL1-RECS2+j]);
GG /= NECHFEN;
if (GG<69) UNVOIS=1;
else UNVOIS=0;*/
L=NECHFEN+DECAL;
p->ialf=0;
deacc(p->M_PIT,p->SIGPI+10,29491,150,&p->ialf);
deacc(p->SIG+SOUDECAL1-RECS2,p->SIGPI+160,29491,211,&p->ialf);
j0=(L-80)/2;
j1=j0+80;
/*
filt_iir(memfil_calp,coef_calp,SIGPI+10,SIG_CALP,361,3); // filtrage
for (j=0;j<90;j++) SIG_CALP[j]=SIG_CALP[4*j]; //d<>cimation par 4
*/
//// decime(SIGPI+10,SIG_CALP,coef_calp,Zai,Zbi,361);
decimation(p->SIGPI+10,p->SIG_CALP,90);
P1=max_autoc(p->SIG_CALP+40,28,5,14)*4;
P2=max_autoc(p->SIG_CALP+20,56,13,28)*4;
/* P1=max_autoc(SIGPI+160,130,LIM_P1,LIM_P1+35);
P2=max_autoc(SIGPI+160-80,280,LIM_P1+30,LIM_P2);
*/
P3=P2/2; p->ialf=P2/3;
if ( (p->ialf>p->mem_pit[0]-17)&&(p->ialf<p->mem_pit[0]+17) && (abs(p->mem_pit[0]-p->ialf)<abs(p->mem_pit[0]-P3))) P3=p->ialf;
left_correl(p,p->SIGPI,j0,j1,P1,2,p->veci1);
left_correl(p,p->SIGPI,j0,j1,P2,2,p->veci2);
left_correl(p,p->SIGPI,j0,j1,P3,2,p->veci3);
right_correl(p,p->SIGPI,j0,j1,P1,2,p->veci1);
right_correl(p,p->SIGPI,j0,j1,P2,2,p->veci2);
right_correl(p,p->SIGPI,j0,j1,P3,2,p->veci3);
P1=max_posit(p->veci1,p->TLSP,P1,5);
P2=max_posit(p->veci2,p->TLSP+2,P2,5);
P3=max_posit(p->veci3,p->TLSP+4,P3,5);
if (p->TLSP[1]>p->TLSP[3]) p->PITCH =P1;
else if ((p->TLSP[1]==p->TLSP[3]) && (p->TLSP[0]>p->TLSP[2])) p->PITCH=P1;
else { p->PITCH=P2; p->TLSP[0]=p->TLSP[2]; p->TLSP[1]=p->TLSP[3];}
if ( (P3>p->mem_pit[0]-17) && (P3<p->mem_pit[0]+17))
{
if (abs(p->mem_pit[1]-p->mem_pit[0])<15) p->TLSP[0] = p->TLSP[0]>>1 + p->TLSP[0]>>2;
if (abs(P3-P1)>6) p->TLSP[0] = p->TLSP[0]>>1 + p->TLSP[0]>>2;
if (p->TLSP[0]<0x40000000L) { p->TLSP[0]<<=1; p->TLSP[1]--;}
// if (TLSP[0]<0x40000000) { TLSP[0]<<=1; TLSP[1]--;}
if (p->TLSP[1]<p->TLSP[5]) p->PITCH =P3;
else if ((p->TLSP[1]==p->TLSP[5]) && (p->TLSP[0]<p->TLSP[4])) p->PITCH=P3;
}
p->mem_pit[1]=p->mem_pit[0];
p->mem_pit[0]=p->PITCH;
}
#endif
// ------------------------------------------------------------------------
// ------------------------------------------------------------------------
// DLL entry points
// ------------------------------------------------------------------------
// ------------------------------------------------------------------------
// ------------------------------------------------------------------------
LH_PREFIX HANDLE LH_SUFFIX MSLHSB_Open_Coder(DWORD dwMaxBitRate)
{
PVOID pCoderData;
/*short i,flag=0;
// Test if there are free handles
for (i=0;i<MAXCODINGHANDLES;i++)
if (CodingHandles[i]==0) {CodingHandles[i]=1; flag=1; break;}
if (flag==0) return 0;
pCoderData=&CoderData[i];*/
// Check the input bit rate param.
if (
#ifdef CELP4800
(dwMaxBitRate != 4800) &&
#endif
(dwMaxBitRate != 8000) && (dwMaxBitRate != 12000) && (dwMaxBitRate != 16000))
return (HANDLE)0;
// pCoderData=(PVOID)GlobalAllocPtr(GMEM_MOVEABLE, dwMaxBitRate == 4800 ? sizeof(C4808DATA) : sizeof(C16008DATA));
#ifdef CELP4800
pCoderData=(PVOID)GlobalAllocPtr(GHND, dwMaxBitRate == 4800 ? sizeof(C4808DATA) : sizeof(C16008DATA));
#else
pCoderData=(PVOID)GlobalAllocPtr(GHND, sizeof(C16008DATA));
#endif
if (pCoderData==NULL)
return (HANDLE)0;
InitializeCoderInstanceData(pCoderData, dwMaxBitRate);
#ifdef __TEST
codage=(FILE*)fopen("codage.dat","wb");
test=(FILE*)fopen("codes_c2.dat","wt");
#endif
return((HANDLE)pCoderData);
}
// ------------------------------------------------------------------------
LH_PREFIX LH_ERRCODE LH_SUFFIX MSLHSB_Encode(
HANDLE hAccess,
LPBYTE lpSrcBuf,
LPWORD lpSrcBufSize,
LPBYTE lpDstBuf,
LPWORD lpDstBufSize)
{
short i,iNBSPF,iMOD_TH1,iMOD_TH2,iMOD_TH3,k,flag=0;
short iNBSB_SP_MAX1,iNBSB_SP_MAX2,iNBSB_SP_MAX3,iNBSB_SP_MAX4;
short *input;
short *in;
unsigned short *ptr2,*ptr4;
unsigned char *ptr1,*ptr3;
long nbb_ave; // Average bit rate on the previous NBFAC frames of speech
short codesizes[24];
long codes[24];
short numcodes,temp;
short ivect8[160];
PVOID pCoderData;
if ((!hAccess) || (!lpSrcBuf) || (!lpDstBuf))
return LH_EBADARG;
// First check that the handle provided as argument is correct
/*for (i=0;i<MAXCODINGHANDLES;i++)
if ((CodingHandles[i]==1)&&(hAccess==(HANDLE)&CoderData[i])) {flag=1; break;}
if (flag==0) return LH_BADHANDLE;*/
pCoderData=(PVOID)hAccess;
// Check the input bit rate param.
if (
#ifdef CELP4800
(((PC4808DATA)pCoderData)->dwMaxBitRate != 4800) &&
#endif
(((PC16008DATA)pCoderData)->dwMaxBitRate != 8000) &&
(((PC16008DATA)pCoderData)->dwMaxBitRate != 12000) &&
(((PC16008DATA)pCoderData)->dwMaxBitRate != 16000))
return (LH_ERRCODE)LH_EBADARG;
#ifdef CELP4800
if ((((PC4808DATA)pCoderData)->dwMaxBitRate == 4800))
{
// then check the buffer sizes passed as argument.
if ((*lpSrcBufSize<2*NECHDECAL)||(*lpDstBufSize<12))
return (LH_ERRCODE)LH_EBADARG;
*lpSrcBufSize=2*NECHDECAL;
*lpDstBufSize=12;
input = (short *)lpSrcBuf;
in=((PC4808DATA)pCoderData)->SIG+SOUDECAL1+RECS2;
for (i=0;i<DECAL;i++) *in++=*input++;
filt_in(((PC4808DATA)pCoderData)->mem2,((PC4808DATA)pCoderData)->SIG+SOUDECAL1+RECS2,((PC4808DATA)pCoderData)->SIG+SOUDECAL1+RECS2,DECAL);
CALPITCH(((PC4808DATA)pCoderData));
COEFF_A(((PC4808DATA)pCoderData));
for (i=0;i<3;i++)
{
if (i==0) ((PC4808DATA)pCoderData)->SOULONG=SOUDECAL1;
else ((PC4808DATA)pCoderData)->SOULONG=SOUDECAL;
((PC4808DATA)pCoderData)->depl=i*4;
RESIDU(((PC4808DATA)pCoderData),i);
PERIODE(((PC4808DATA)pCoderData),i);
CHERCHE(((PC4808DATA)pCoderData));
dsynthesis(((PC4808DATA)pCoderData)->DMSY,((PC4808DATA)pCoderData)->A1,((PC4808DATA)pCoderData)->E,((PC4808DATA)pCoderData)->E_PE,((PC4808DATA)pCoderData)->SOULONG,NETAGES);
for (k=0;k<=11;k++) ((PC4808DATA)pCoderData)->MINV[12-k] = ((PC4808DATA)pCoderData)->E_PE[((PC4808DATA)pCoderData)->SOULONG-12+k];
((PC4808DATA)pCoderData)->MINV[0]=(short)(((PC4808DATA)pCoderData)->DMSY[0] >> 16);
}
FRAME(((PC4808DATA)pCoderData));
short_to_short(((PC4808DATA)pCoderData)->SIG+SOUDECAL1-RECS2,((PC4808DATA)pCoderData)->M_PIT,160);
short_to_short(((PC4808DATA)pCoderData)->SIG+NECHDECAL,((PC4808DATA)pCoderData)->SIG,SOUDECAL1+RECS2);
ptr4 = (unsigned short *)&((PC4808DATA)pCoderData)->output_frame;
ptr2 = (unsigned short *)lpDstBuf;
for (i =0;i<6;i++) ptr2[i] = ptr4[i];
}
else
#endif
{
input = (short *)lpSrcBuf;
((PC16008DATA)pCoderData)->nbbit_cf=0;
// then check the buffer sizes passed as argument.
switch (((PC16008DATA)pCoderData)->dwMaxBitRate)
{
case 8000:
if ((*lpSrcBufSize<2*160)||(*lpDstBufSize<MAX_OUTPUT_BYTES_8000_12000))
return (LH_ERRCODE)LH_EBADARG;
*lpSrcBufSize=2*160;
for (i=0;i<160;i++) ((PC16008DATA)pCoderData)->DATA_I[i]=(*input++)>>1; // TEST >>2
#ifdef _X86_
PassLow8(((PC16008DATA)pCoderData)->DATA_I,ivect8,((PC16008DATA)pCoderData)->memBP,160);
iConvert8To64(ivect8,((PC16008DATA)pCoderData)->DATA_I,160,((PC16008DATA)pCoderData)->imem1);
#else
SampleRate8000To6400(((PC16008DATA)pCoderData)->DATA_I,
((PC16008DATA)pCoderData)->DATA_I,
160,
((PC16008DATA)pCoderData)->imem1,
&((PC16008DATA)pCoderData)->uiDelayPosition,
&((PC16008DATA)pCoderData)->iInputStreamTime,
&((PC16008DATA)pCoderData)->iOutputStreamTime );
#endif
break;
case 12000:
if ((*lpSrcBufSize<2*128)||(*lpDstBufSize<MAX_OUTPUT_BYTES_8000_12000))
return (LH_ERRCODE)LH_EBADARG;
*lpSrcBufSize=2*128;
for (i=0;i<128;i++) ((PC16008DATA)pCoderData)->DATA_I[i]=(*input++)>>1; // TEST >>2
break;
case 16000:
if ((*lpSrcBufSize<2*128)||(*lpDstBufSize<MAX_OUTPUT_BYTES_16000))
return (LH_ERRCODE)LH_EBADARG;
*lpSrcBufSize=2*128;
for (i=0;i<128;i++) ((PC16008DATA)pCoderData)->DATA_I[i]=(*input++)>>1; // TEST >>2
break;
}
code_res_I(((PC16008DATA)pCoderData),((PC16008DATA)pCoderData)->DATA_I,coef_I,((PC16008DATA)pCoderData)->QMF_MEM_ANAL_I,((PC16008DATA)pCoderData)->codes_max,
((PC16008DATA)pCoderData)->codes_sb,((PC16008DATA)pCoderData)->indic_sp);
//*#ifdef __VARIABLE__
for (i=NBFAC-1;i>0;i--)
{
((PC16008DATA)pCoderData)->nbbit[i]=((PC16008DATA)pCoderData)->nbbit[i-1]; // on re-adapte les tranches precedentes
}
((PC16008DATA)pCoderData)->nbbit[0]=((PC16008DATA)pCoderData)->nbbit_cf; // valeur pour la tranche actuelle
nbb_ave=0L;
for (i=0;i<NBFAC;i++) nbb_ave+=(long)((PC16008DATA)pCoderData)->nbbit[i];
if (((PC16008DATA)pCoderData)->dwMaxBitRate == 8000)
{
iNBSPF = NBSPF_4800_8000;
iMOD_TH1 = MOD_TH1_8000;
iMOD_TH2 = MOD_TH2_8000;
iMOD_TH3 = MOD_TH3_8000;
iNBSB_SP_MAX1 = NBSB_SP_MAX1_8000_12000;
iNBSB_SP_MAX2 = NBSB_SP_MAX2_8000_12000;
iNBSB_SP_MAX3 = NBSB_SP_MAX3_8000_12000;
iNBSB_SP_MAX4 = NBSB_SP_MAX4_8000_12000;
}
else
{
iNBSPF = NBSPF_12000_16000;
iMOD_TH1 = MOD_TH1_12000_16000;
if (((PC16008DATA)pCoderData)->dwMaxBitRate == 12000)
{
iMOD_TH2 = MOD_TH2_12000;
iMOD_TH3 = MOD_TH3_12000;
iNBSB_SP_MAX1 = NBSB_SP_MAX1_8000_12000;
iNBSB_SP_MAX2 = NBSB_SP_MAX2_8000_12000;
iNBSB_SP_MAX3 = NBSB_SP_MAX3_8000_12000;
iNBSB_SP_MAX4 = NBSB_SP_MAX4_8000_12000;
}
else
{
iMOD_TH2 = MOD_TH2_16000;
iMOD_TH3 = MOD_TH3_16000;
iNBSB_SP_MAX1 = NBSB_SP_MAX1_16000;
iNBSB_SP_MAX2 = NBSB_SP_MAX2_16000;
iNBSB_SP_MAX3 = NBSB_SP_MAX3_16000;
iNBSB_SP_MAX4 = NBSB_SP_MAX4_16000;
}
}
nbb_ave=(short)((nbb_ave*F_ECH)/(NBFAC*iNBSPF));
// On retablit les seuils en fonction de la moyenne calculee
if (nbb_ave<=iMOD_TH1)
{
((PC16008DATA)pCoderData)->MAX_LEVEL = MAX_LEVEL1; // valeur par defaut si le debit n'augmente pas trop
((PC16008DATA)pCoderData)->DIV_MAX = DIV_MAX1; // cad on ne traite pas les sb < 5% du max[i]
((PC16008DATA)pCoderData)->NBSB_SP_MAX = iNBSB_SP_MAX1; // nbre max de sb pouvant etre du signal
}
else
{
if (nbb_ave<=iMOD_TH2) // on a depasse le 1er seuils mais pas le 2eme
{
((PC16008DATA)pCoderData)->MAX_LEVEL = MAX_LEVEL2; // on rejette plus de tranches
((PC16008DATA)pCoderData)->DIV_MAX = DIV_MAX2; // cad on ne traite pas les sb < 7% du max[i]
((PC16008DATA)pCoderData)->NBSB_SP_MAX = iNBSB_SP_MAX2; // nbre max de sb pouvant etre du signal
}
else
{
if (nbb_ave<=iMOD_TH3) // on a depasse le 1er seuils mais pas le 2eme
{
((PC16008DATA)pCoderData)->MAX_LEVEL = MAX_LEVEL3; // on rejette un max
((PC16008DATA)pCoderData)->DIV_MAX = DIV_MAX3; // cad on ne traite pas les sb < 5% du max[i]
((PC16008DATA)pCoderData)->NBSB_SP_MAX = iNBSB_SP_MAX3; // nbre max de sb pouvant etre du signal
}
else // on a depasse le troisieme seuil; il faut descendre!
{
((PC16008DATA)pCoderData)->MAX_LEVEL = MAX_LEVEL4; // meme seuil de rejet
((PC16008DATA)pCoderData)->DIV_MAX = DIV_MAX4; // cad on ne traite pas les sb <10% du max[i]
((PC16008DATA)pCoderData)->NBSB_SP_MAX = iNBSB_SP_MAX4; // nbre max de sb pouvant etre du signal
}
}
}/**/
((PC16008DATA)pCoderData)->stream[0]=0;
for (i=0;i<8;i++)
((PC16008DATA)pCoderData)->stream[0]|=(((PC16008DATA)pCoderData)->indic_sp[i]&0x01)<<i;
numcodes=0;
//temp=bytes[((PC16008DATA)pCoderData)->nbsb_sp];
#if 0
temp=(short)((float)((PC16008DATA)pCoderData)->nbbit_cf/8.0+0.99);
#else
// We want to go away of libcmt, msvcrt... and
// floating point is not really essential here...
if (((PC16008DATA)pCoderData)->nbbit_cf)
temp=(short)((((PC16008DATA)pCoderData)->nbbit_cf-1)/8+1);
else
temp=0;
#endif
for (i=0;i<24;i++) codesizes[i]=0;
for (i=0;i<((PC16008DATA)pCoderData)->nbsb_sp;i++)
{
codes[i]=(long)((PC16008DATA)pCoderData)->codes_max[i];
codes[((PC16008DATA)pCoderData)->nbsb_sp+2*i]=(long)((PC16008DATA)pCoderData)->codes_sb[2*i];
codes[((PC16008DATA)pCoderData)->nbsb_sp+2*i+1]=(long)((PC16008DATA)pCoderData)->codes_sb[2*i+1];
codesizes[i]=5;
codesizes[((PC16008DATA)pCoderData)->nbsb_sp+2*i]=((PC16008DATA)pCoderData)->bits[i]/2;
codesizes[((PC16008DATA)pCoderData)->nbsb_sp+2*i+1]=((PC16008DATA)pCoderData)->bits[i]/2;
numcodes+=3;
}
if (((PC16008DATA)pCoderData)->dwMaxBitRate == 16000)
{
for (i=((PC16008DATA)pCoderData)->nbsb_sp;i<8;i++)
{
codes[2*((PC16008DATA)pCoderData)->nbsb_sp+i]=(long)((PC16008DATA)pCoderData)->codes_max[i];
codes[8+2*i]=(long)((PC16008DATA)pCoderData)->codes_sb[2*i];
codes[8+2*i+1]=(long)((PC16008DATA)pCoderData)->codes_sb[2*i+1];
codesizes[2*((PC16008DATA)pCoderData)->nbsb_sp+i]=5;
codesizes[8+2*i]=SILENCE_CODING_BIT_16000/2;
codesizes[8+2*i+1]=SILENCE_CODING_BIT_16000/2;
numcodes+=3;
}
Multiplexing(((PC16008DATA)pCoderData)->stream+1,codes,codesizes,numcodes,(short)(temp-1));
}
else
if (((PC16008DATA)pCoderData)->nbsb_sp)
Multiplexing(((PC16008DATA)pCoderData)->stream+1,codes,codesizes,numcodes,(short)(temp-1));
*lpDstBufSize=temp;
ptr3 = (unsigned char *)&((PC16008DATA)pCoderData)->stream;
ptr1 = (unsigned char *)lpDstBuf;
for (i =0;i<*lpDstBufSize;i++) ptr1[i] = ptr3[i];
}
return (LH_SUCCESS);
}
// ------------------------------------------------------------------------
LH_PREFIX LH_ERRCODE LH_SUFFIX MSLHSB_Close_Coder(HANDLE hAccess)
{
PVOID pCoderData;
/*short i,flag=0;
// Check if right handle
for (i=0;i<MAXCODINGHANDLES;i++)
if ((CodingHandles[i]==1)&&(hAccess==(HANDLE)&CoderData[i])) {flag=1; break;}
if (flag==0) return LH_BADHANDLE;
// Free handle
CodingHandles[i]=0;*/
if (!hAccess)
return LH_EBADARG;
pCoderData=(PVOID)hAccess;
GlobalFreePtr(pCoderData);
#ifdef __TEST
fclose(codage);
fclose(test);
#endif
return LH_SUCCESS;
}
Reference in a new issue Copy permalink