blob: c79062c4c8ec835096ebfee47d914410c6ac2018 [file] [log] [blame]
/* ------------------------------------------------------------------
* Copyright (C) 1998-2009 PacketVideo
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either
* express or implied.
* See the License for the specific language governing permissions
* and limitations under the License.
* -------------------------------------------------------------------
*/
/*
------------------------------------------------------------------------------
PacketVideo Corp.
MP3 Decoder Library
Filename: pvmp3_mpeg2_stereo_proc.cpp
Functions:
pvmp3_st_intensity_ver2
pvmp3_mpeg2_stereo_proc
Date: 09/21/2007
------------------------------------------------------------------------------
REVISION HISTORY
Description:
------------------------------------------------------------------------------
pvmp3_st_intensity_ver2
INPUT AND OUTPUT DEFINITIONS
Input
int32 xr[], input channel
int32 xl[],
int32 m, selecting index: io = 2(1/4) (m=0), io = 2(1/8) (m=1)
int32 is_pos, index on table is_pos_pow_eitgh_root_of_2
int32 Start, Location of first element where stereo intensity is applied
int32 Number number of elements affected
Returns
int32 xl[], generated stereo channel
------------------------------------------------------------------------------
pvmp3_mpeg2_stereo_proc
INPUT AND OUTPUT DEFINITIONS
Input
int32 xr[], input channel
int32 xl[],
mp3ScaleFactors *scalefac, scale factors structure for Right channel
granuleInfo *gr_info_l, granule structure for the left channel
granuleInfo *gr_info_r, granule structure for the rigth channel
uint32 *scalefac_IIP_buffer, auxiliary scale factor vector
mp3Header *info mp3 header info
Returns
int32 xl[], generated stereo channel
------------------------------------------------------------------------------
FUNCTION DESCRIPTION
stereo processing for mpeg2 layer III LSF extension
------------------------------------------------------------------------------
REQUIREMENTS
------------------------------------------------------------------------------
REFERENCES
[1] ISO MPEG Audio Subgroup Software Simulation Group (1996)
ISO 13818-3 MPEG-2 Audio Decoder - Lower Sampling Frequency Extension
------------------------------------------------------------------------------
PSEUDO-CODE
------------------------------------------------------------------------------
*/
/*----------------------------------------------------------------------------
; INCLUDES
----------------------------------------------------------------------------*/
#include "pvmp3_mpeg2_stereo_proc.h"
#include "pvmp3_stereo_proc.h"
#include "pv_mp3dec_fxd_op.h"
#include "pvmp3_tables.h"
#include "mp3_mem_funcs.h"
/*----------------------------------------------------------------------------
; MACROS
; Define module specific macros here
----------------------------------------------------------------------------*/
/*----------------------------------------------------------------------------
; DEFINES
; Include all pre-processor statements here. Include conditional
; compile variables also.
----------------------------------------------------------------------------*/
#define Q31_fmt(a) (int32(double(0x7FFFFFFF)*a))
/*----------------------------------------------------------------------------
; LOCAL FUNCTION DEFINITIONS
; Function Prototype declaration
----------------------------------------------------------------------------*/
/*----------------------------------------------------------------------------
; LOCAL STORE/BUFFER/POINTER DEFINITIONS
; Variable declaration - defined here and used outside this module
----------------------------------------------------------------------------*/
const int32 is_pos_pow_eitgh_root_of_2[8] =
{
/* --- 2^(1/8) ----- */
Q31_fmt(1.00000000000000), Q31_fmt(0.91700404320467), Q31_fmt(0.84089641525371),
Q31_fmt(0.77110541270397), Q31_fmt(0.70710678118655), Q31_fmt(0.64841977732550),
Q31_fmt(0.59460355750136), Q31_fmt(0.54525386633263)
};
/*----------------------------------------------------------------------------
; EXTERNAL FUNCTION REFERENCES
; Declare functions defined elsewhere and referenced in this module
----------------------------------------------------------------------------*/
/*----------------------------------------------------------------------------
; EXTERNAL GLOBAL STORE/BUFFER/POINTER REFERENCES
; Declare variables used in this module but defined elsewhere
----------------------------------------------------------------------------*/
/*----------------------------------------------------------------------------
; FUNCTION CODE
----------------------------------------------------------------------------*/
void pvmp3_st_intensity_ver2(int32 xr[SUBBANDS_NUMBER*FILTERBANK_BANDS],
int32 xl[SUBBANDS_NUMBER*FILTERBANK_BANDS],
int32 m,
int32 is_pos,
int32 Start,
int32 Number)
{
int32 k[2];
/* pow(io, ((is_pos + 1)>>1)); io = 2(1/4) (m=0), io = 2(1/8) (m=1) */
k[0] = is_pos_pow_eitgh_root_of_2[((is_pos+1)&(3+(m<<2)))<<(1-m)] >> ((is_pos + 1) >> (2 + m));
/* pow(io, (is_pos>>1)); io = 2(1/4) (m=0), io = 2(1/8) (m=1) */
k[1] = is_pos_pow_eitgh_root_of_2[(is_pos&(3+(m<<2)))<<(1-m)] >> (is_pos >> (2 + m));
int32 *pt_xr = &xr[Start];
int32 *pt_xl = &xl[Start];
if (is_pos == 0) /* 0 < is_pos < 31 */
{
pv_memcpy(pt_xl, pt_xr, Number*sizeof(*pt_xr));
}
else if (is_pos & 1)
{
for (int32 i = Number >> 1; i != 0; i--)
{
*(pt_xl++) = (*pt_xr);
*(pt_xr) = fxp_mul32_Q32((*pt_xr) << 1, k[0]);
pt_xr++;
*(pt_xl++) = (*pt_xr);
*(pt_xr) = fxp_mul32_Q32((*pt_xr) << 1, k[0]);
pt_xr++;
}
if (Number&1)
{
*(pt_xl) = (*pt_xr);
*(pt_xr) = fxp_mul32_Q32((*pt_xr) << 1, k[0]);
}
}
else
{
for (int32 i = Number >> 1; i != 0; i--)
{
*(pt_xl++) = fxp_mul32_Q32((*(pt_xr++)) << 1, k[1]);
*(pt_xl++) = fxp_mul32_Q32((*(pt_xr++)) << 1, k[1]);
}
if (Number&1)
{
*(pt_xl) = fxp_mul32_Q32((*pt_xr) << 1, k[1]);
}
}
}
/*----------------------------------------------------------------------------
; FUNCTION CODE
----------------------------------------------------------------------------*/
void pvmp3_mpeg2_stereo_proc(int32 xr[SUBBANDS_NUMBER*FILTERBANK_BANDS],
int32 xl[SUBBANDS_NUMBER*FILTERBANK_BANDS],
mp3ScaleFactors *scalefac_R,
granuleInfo *gr_info_l,
granuleInfo *gr_info_r,
uint32 *scalefac_IIP_buffer,
int32 used_freq_lines,
mp3Header *info)
{
int32 sfreq;
int32 sb;
int32 ss;
int32 sfbNo;
int32 sfbStart;
int32 sfb;
int32 sfbTemp;
int32 i;
int32 j;
int32 io;
int32 i_stereo = (info->mode == MPG_MD_JOINT_STEREO) &&
(info->mode_ext & 0x1);
int32 ms_stereo = (info->mode == MPG_MD_JOINT_STEREO) &&
(info->mode_ext & 0x2);
if (i_stereo)
{
if (gr_info_r->scalefac_compress & 1)
{
io = 0; /* 2^(-1/4) */
}
else
{
io = 1; /* 2^(-1/8) */
}
sfreq = info->version_x + (info->version_x << 1);
sfreq += info->sampling_frequency;
if (gr_info_l->window_switching_flag && (gr_info_l->block_type == 2))
{
if (gr_info_l->mixed_block_flag)
{
/*
* mixed blocks processing
*/
i = 31;
ss = 17;
sb = -1;
while (i >= 0)
{
if (xl[(i*FILTERBANK_BANDS) + ss])
{
sb = (i << 4) + (i << 1) + ss;
i = -1;
}
else
{
ss--;
if (ss < 0)
{
i--;
ss = 17;
}
}
} /* now sb is the number of highest line with value != 0 */
/* can be between -1 (all lines zero) and 575 (no line zero) */
if (sb < 36) /* was (sb <= 36) */
{
/*
* mixed blocks processing: intensity bound inside long blocks
*/
/* 1. long blocks up to intensity border: Stereo or M/S */
if (mp3_sfBandIndex[sfreq].l[4] <= sb)
{
i = 4;
}
else
{
i = 0;
}
while (mp3_sfBandIndex[sfreq].l[i] <= sb)
{
i++;
}
sfbTemp = i; /* from that (long) sfb on we have intensity stereo */
sfbNo = mp3_sfBandIndex[sfreq].l[sfbTemp]; /* number of lines to process */
/* from sfbStart up sfbNo lines do ms_stereo or normal stereo */
if (ms_stereo)
{
pvmp3_st_mid_side(xr, xl, 0, sfbNo);
}
/* 2. long blocks from intensity border up to sfb band 6: intensity */
/* calc. MPEG_1_2_Factor[0], MPEG_1_2_Factor[1] */
for (sfb = sfbTemp; sfb < 6; sfb++)
{
sfbStart = mp3_sfBandIndex[sfreq].l[sfb]; /* = Start in 0 ... 575 */
sfbNo = mp3_sfBandIndex[sfreq].l[sfb+1] - mp3_sfBandIndex[sfreq].l[sfb]; /* No of lines to process */
if ((uint32)(scalefac_R->l[sfb]) != scalefac_IIP_buffer[sfb])
{
pvmp3_st_intensity_ver2(xr, xl, io, scalefac_R->l[sfb], sfbStart, sfbNo);
}
else if (ms_stereo)
{
pvmp3_st_mid_side(xr, xl, sfbStart, sfbNo);
}
}
/* 3. now process all sfb with short blocks (3...12), all in intensity mode */
for (j = 0; j < 3; j++)
{
/* first calculate directional factors for intensity stereo,
* for all sfb in intensity mode, but only
* if they do not have "illegal" position:
*/
/* to do this for all sfb we have to get information for last scale factor band:
* here we clearly have more than one sfb in intensity mode,
* so copy factors and legal/illegal information from sfb11 to sfb12
*/
(scalefac_R->s[j][12]) = (scalefac_R->s[j][11]);
scalefac_IIP_buffer[36 + j] = scalefac_IIP_buffer[33 + j]; /* legal/illegal in sfb 12 same as in sfb 11 */
for (sfb = 3; sfb < 13; sfb++)
{
sfbNo = mp3_sfBandIndex[sfreq].s[sfb+1] - mp3_sfBandIndex[sfreq].s[sfb]; /* No of lines to process */
sfbStart = 3 * mp3_sfBandIndex[sfreq].s[sfb] + j * sfbNo;
if ((uint32)(scalefac_R->s[j][sfb]) != scalefac_IIP_buffer[3*sfb + j])
{
pvmp3_st_intensity_ver2(xr, xl, io, scalefac_R->s[j][sfb], sfbStart, sfbNo);
}
else if (ms_stereo)
{
pvmp3_st_mid_side(xr, xl, sfbStart, sfbNo);
}
}
} /* for (j = 0; j < 3; j++) */
}
else /* else then (sb >= 36) */
{
/*
* mixed blocks processing: intensity bound outside long blocks
*/
/* 2. short blocks, do for all 3 */
/* ------------------------------ */
for (j = 0; j < 3; j++)
{
int32 sfbcnt = -1;
for (sfb = 12; sfb >= 3; sfb--)
{
int32 lines = mp3_sfBandIndex[sfreq].s[sfb+1] - mp3_sfBandIndex[sfreq].s[sfb];
i = 3 * mp3_sfBandIndex[sfreq].s[sfb] + (j + 1) * lines - 1;
while (lines > 0)
{
if (xl[i])
{
sfbcnt = sfb;
sfb = -10;
lines = -10;
}
lines--;
i--;
}
}
sfbcnt += 1;
if (sfbcnt < 3)
{
sfbcnt = 3; /* should not be necessary */
}
sfbTemp = sfbcnt; /* from this (short) sfb on we have intensity mode */
/* can have values between 3 (all short sfb in intensity) */
/* and 13 (no short sfb in intensity mode) */
/* 3. from sfbTemp to last sfb calculate is_ratio values: */
/* first calculate directional factors for intensity stereo, */
/* for all sfb in intensity mode, but only */
/* if they do not have "illegal" position: */
/* to do this for all sfb we have to get information for last scale factor band: */
/* get factors for last scale factor band: */
/* more than one sfb in intensity mode,
copy factors and legal/illegal information from sfb11 to sfb12 */
if (sfbTemp < 12)
{
(scalefac_R->s[j][12]) = (scalefac_R->s[j][11]);
scalefac_IIP_buffer[36 + j] = scalefac_IIP_buffer[33 + j]; /* legal/illegal in sfb 12 same as in sfb 11 */
}
else if (sfbTemp == sfb)
/* only sfb 12 in intensity mode, use factors corresponding to is_pos[12] == 0 */
{
(scalefac_R->s[j][12]) = 0;
scalefac_IIP_buffer[36 + j] = 1; /* the scf value 0 in sfb12 is "legal" */
}
/* if sfbTemp > sfb (no sfb in intensity mode): do nothing */
/* 4. do normal stereo or MS stereo from sfb 3 to < sfbTemp: */
for (sfb = 3; sfb < sfbTemp; sfb++)
{
sfbNo = mp3_sfBandIndex[sfreq].s[sfb+1] - mp3_sfBandIndex[sfreq].s[sfb];
sfbStart = 3 * mp3_sfBandIndex[sfreq].s[sfb] + j * sfbNo;
if (ms_stereo)
{
pvmp3_st_mid_side(xr, xl, sfbStart, sfbNo);
}
}
/* 5. now intensity stereo processing of the remaining sfb's: */
for (sfb = sfbTemp; sfb < 13; sfb++)
{
sfbNo = mp3_sfBandIndex[sfreq].s[sfb+1] - mp3_sfBandIndex[sfreq].s[sfb]; /* No of lines to process */
sfbStart = 3 * mp3_sfBandIndex[sfreq].s[sfb] + j * sfbNo;
if ((uint32)(scalefac_R->s[j][sfb]) != scalefac_IIP_buffer[3*sfb + j])
{
pvmp3_st_intensity_ver2(xr, xl, io, scalefac_R->s[j][sfb], sfbStart, sfbNo);
}
else if (ms_stereo)
{
pvmp3_st_mid_side(xr, xl, sfbStart, sfbNo);
}
}
/* end of correction by efs 2003-07-04 */
} /* for (j = 0; j < 3; j++) */
/* long blocks 0 up to sfb band 6: no intensity */
sfbNo = mp3_sfBandIndex[sfreq].l[6]; /* number of lines to process */
if (ms_stereo)
{
pvmp3_st_mid_side(xr, xl, 0, sfbNo);
}
} /* if intensity bound inside or outside long blocks */
} /* if (gr_info->mixed_block_flag) */
else
{
/*
* short block processing
*/
for (j = 0; j < 3; j++)
{
int32 sfbcnt = -1;
for (sfb = 12; sfb >= 0; sfb--)
{
int32 lines = mp3_sfBandIndex[sfreq].s[sfb+1] - mp3_sfBandIndex[sfreq].s[sfb];
i = 3 * mp3_sfBandIndex[sfreq].s[sfb] + (j + 1) * lines - 1;
while (lines > 0)
{
if (xl[i])
{
sfbcnt = sfb;
sfb = -10;
lines = -10;
}
lines--;
i--;
}
}
sfbcnt += 1;
/* start of corrected version by efs 2003-07-04 */
sfbTemp = sfbcnt; /* from this (short) sfb on we have intensity mode */
/* can have values between 3 (all short sfb in intensity) */
/* and 13 (no short sfb in intensity mode) */
/* first calculate directional factors for intensity stereo,
for all sfb in intensity mode, but only
if they do not have "illegal" position: */
/* to do this for all sfb we have to get information for last scale factor band: */
/* get factors for last scale factor band: */
/* more than one sfb in intensity mode,
copy factors and legal/illegal information from sfb11 to sfb12 */
if (sfbTemp < 12)
{
(scalefac_R->s[j][12]) = (scalefac_R->s[j][11]);
scalefac_IIP_buffer[36 + j] = scalefac_IIP_buffer[33 + j]; /* legal/illegal in sfb 12 same as in sfb 11 */
}
else if (sfbTemp == 12)
/* only sfb 12 in intensity mode, use factors corresponding to is_pos[12] == 0 */
{
(scalefac_R->s[j][12]) = 0;
scalefac_IIP_buffer[36 + j] = 1; /* the scf value 0 in sfb12 is "legal" */
}
/* if sfbTemp > sfb (no sfb in intensity mode): do nothing */
/* Now process audio samples */
/* first process lower sfb's not in intensity mode */
for (sfb = 0; sfb < sfbTemp; sfb++)
{
sfbNo = mp3_sfBandIndex[sfreq].s[sfb+1] - mp3_sfBandIndex[sfreq].s[sfb];
sfbStart = 3 * mp3_sfBandIndex[sfreq].s[sfb] + j * sfbNo;
if (ms_stereo)
{
pvmp3_st_mid_side(xr, xl, sfbStart, sfbNo);
}
}
/* now intensity stereo processing of the remaining sfb's: */
for (sfb = sfbTemp; sfb < 13; sfb++)
{
sfbNo = mp3_sfBandIndex[sfreq].s[sfb+1] - mp3_sfBandIndex[sfreq].s[sfb]; /* No of lines to process */
sfbStart = 3 * mp3_sfBandIndex[sfreq].s[sfb] + j * sfbNo;
if ((uint32)(scalefac_R->s[j][sfb]) != scalefac_IIP_buffer[3*sfb + j])
{
pvmp3_st_intensity_ver2(xr, xl, io, scalefac_R->s[j][sfb], sfbStart, sfbNo);
}
else if (ms_stereo)
{
pvmp3_st_mid_side(xr, xl, sfbStart, sfbNo);
}
}
} /* for (j = 0; j < 3; j++) */
} /* end of else ( gr_info->mixed_block_flag) */
} /* if (gr_info->window_switching_flag && (gr_info->block_type == 2)) */
else
{
/*
* long block processing
*/
i = 31;
ss = 17;
sb = 0;
while (i >= 0)
{
if (xl[(i*FILTERBANK_BANDS) + ss])
{
sb = (i << 4) + (i << 1) + ss;
/* i = -1 patched RF 24-09-2002 */
i = -2;
}
else
{
ss--;
if (ss < 0)
{
i--;
ss = 17;
}
}
}
/* patched RF 24-09-2002 */
if (sb)
{
if (mp3_sfBandIndex[sfreq].l[14] <= sb)
{
i = 14;
}
else if (mp3_sfBandIndex[sfreq].l[7] <= sb)
{
i = 7;
}
else
{
i = 0;
}
while (mp3_sfBandIndex[sfreq].l[i] <= sb)
{
i++;
}
}
else
{
if (i == -1)
{
/* all xr[1][][] are 0: set IS bound sfb to 0 */
i = 0;
}
else
{
/* xr[1][0][0] is unequal 0 and all others are 0: set IS bound sfb to 1 */
i = 1;
}
}
/* corrected version by efs 2003-07-04 */
sfbTemp = i; /* from this (long) sfb on we have intensity mode */
/* can have values between 0 (all long sfb in intensity) */
/* and 22 (no long sfb in intensity mode) */
/* first calculate directional factors for intensity stereo,
for all sfb in intensity mode, but only if they
do not have "illegal" position: */
/* to do this for all sfb we have to get information for last scale factor band: */
if (sfbTemp < 21)
/* more than one sfb in intensity mode, */
/* copy factors and legal/illegal information from sfb20 to sfb21 */
{
(scalefac_R->l[21]) = (scalefac_R->l[20]);
scalefac_IIP_buffer[21] = scalefac_IIP_buffer[20]; /* legal/illegal in sfb 21 same as in sfb 20 */
}
else if (sfbTemp == 21)
/* only sfb 21 in intensity mode, is_pos[21] = 0 */
{
(scalefac_R->l[21]) = 0;
scalefac_IIP_buffer[21] = 1; /* the scf value 0 in sfb21 is "legal" */
}
/* if sfbTemp > 21 (no sfb in intensity mode): do nothing */
/* Now process audio samples */
/* first process lower sfb's not in intensity mode */
sfbNo = mp3_sfBandIndex[sfreq].l[sfbTemp] - mp3_sfBandIndex[sfreq].l[0];
sfbStart = mp3_sfBandIndex[sfreq].l[0];
if (ms_stereo)
{
pvmp3_st_mid_side(xr, xl, sfbStart, sfbNo);
}
/* now intensity stereo processing of the remaining sfb's: */
for (sfb = sfbTemp; sfb < 22; sfb++)
{
sfbNo = mp3_sfBandIndex[sfreq].l[sfb+1] - mp3_sfBandIndex[sfreq].l[sfb]; /* number of lines to process */
sfbStart = mp3_sfBandIndex[sfreq].l[sfb]; /* start of sfb */
if ((uint32)(scalefac_R->l[sfb]) != scalefac_IIP_buffer[sfb]) /* "legal" position ? */
{
pvmp3_st_intensity_ver2(xr, xl, io, scalefac_R->l[sfb], sfbStart, sfbNo);
}
else if (ms_stereo)
{
pvmp3_st_mid_side(xr, xl, sfbStart, sfbNo);
}
} /* for (sfb = sfbTemp; sfb < 22; sfb++) */
} /* if (gr_info->window_switching_flag && (gr_info->block_type == 2)) */
} /* if (i_stereo) */
else
{
/*
* normal or ms stereo processing
*/
if (ms_stereo)
{
pvmp3_st_mid_side(xr, xl, 0, used_freq_lines);
}
} /* if (i_stereo) */
}