blob: f36a1ae4d11c534becafa68b5da6f19e2f5ab31a [file] [log] [blame]
/******************************************************************************
* *
* Copyright (C) 2018 The Android Open Source Project
*
* 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.
*
*****************************************************************************
* Originally developed and contributed by Ittiam Systems Pvt. Ltd, Bangalore
*/
#include <string.h>
#include <ixheaacd_type_def.h>
#include "ixheaacd_constants.h"
#include <ixheaacd_basic_ops32.h>
#include "ixheaacd_windows.h"
static PLATFORM_INLINE WORD32 ixheaacd_mult32_sh1(WORD32 a, WORD32 b) {
WORD32 result;
WORD64 temp_result;
temp_result = (WORD64)a * (WORD64)b;
result = (WORD32)(temp_result >> 31);
return (result);
}
VOID ixheaacd_memset(FLOAT32 *x, WORD32 n) {
memset(x, 0, n * sizeof(FLOAT32));
return;
}
VOID ixheaacd_mem_cpy(const FLOAT32 x[], FLOAT32 y[], WORD32 n) {
memcpy(y, x, n * sizeof(FLOAT32));
return;
}
VOID ixheaacd_vec_cnst_mul(FLOAT32 a, FLOAT32 x[], FLOAT32 z[], WORD32 n) {
WORD32 i;
for (i = 0; i < n; i++) {
z[i] = (FLOAT32)a * x[i];
}
return;
}
VOID ixheaacd_combine_fac(WORD32 *src1, WORD32 *src2, WORD32 *dest, WORD32 len,
WORD8 output_q, WORD8 fac_q) {
WORD32 i;
if (fac_q > output_q) {
for (i = 0; i < len; i++) {
*dest = ixheaacd_add32_sat(*src1, ((*src2) >> (fac_q - output_q)));
dest++;
src1++;
src2++;
}
} else {
for (i = 0; i < len; i++) {
*dest = ixheaacd_add32_sat(*src1, ((*src2) << (output_q - fac_q)));
dest++;
src1++;
src2++;
}
}
}
WORD8 ixheaacd_windowing_long1(WORD32 *src1, WORD32 *src2,
const WORD32 *win_fwd, const WORD32 *win_rev,
WORD32 *dest, WORD32 vlen, WORD8 shift1,
WORD8 shift2) {
WORD32 i;
WORD32 *rsrc2 = src2 + vlen - 1;
if (shift1 > shift2) {
for (i = 0; i < vlen / 2; i++) {
*dest = ixheaacd_add32_sat(
((ixheaacd_mult32_sh1(*src1, *win_fwd)) >> (shift1 - shift2)),
ixheaacd_mult32_sh1(*src2, *win_rev));
*(dest + (vlen - (2 * i)) - 1) = ixheaacd_add32_sat(
((ixheaacd_mult32_sh1(-(*src1), *win_rev)) >> (shift1 - shift2)),
ixheaacd_mult32_sh1(*rsrc2, *win_fwd));
src1++;
src2++;
win_fwd++;
win_rev--;
rsrc2--;
dest++;
}
return (shift2);
} else {
for (i = 0; i < vlen / 2; i++) {
*dest = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(*src1, *win_fwd),
((ixheaacd_mult32_sh1(*src2, *win_rev)) >> (shift2 - shift1)));
*(dest + (vlen - (2 * i)) - 1) = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(-(*src1), *win_rev),
((ixheaacd_mult32_sh1(*rsrc2, *win_fwd)) >> (shift2 - shift1)));
src1++;
src2++;
win_fwd++;
win_rev--;
rsrc2--;
dest++;
}
return (shift1);
}
}
WORD8 ixheaacd_windowing_long2(WORD32 *src1, const WORD32 *win_fwd,
WORD32 *fac_data_out, WORD32 *over_lap,
WORD32 *p_out_buffer,
offset_lengths *ixheaacd_drc_offset,
WORD8 shiftp, WORD8 shift_olap, WORD8 fac_q) {
WORD32 i;
WORD32 *dest = p_out_buffer;
win_fwd += ixheaacd_drc_offset->lfac;
if (shiftp > fac_q) {
if (shift_olap > fac_q) {
for (i = 0;
i < ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->lfac;
i++) {
dest[i] = over_lap[i] >> (shift_olap - fac_q);
}
for (i = ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->lfac;
i < ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->n_trans_ls;
i++) {
dest[i] = ixheaacd_add32_sat(
(ixheaacd_mult32_sh1(-src1[ixheaacd_drc_offset->n_long / 2 +
ixheaacd_drc_offset->n_flat_ls +
ixheaacd_drc_offset->lfac - i - 1],
*win_fwd) >>
(shiftp - fac_q)),
(*fac_data_out));
win_fwd++;
fac_data_out++;
}
for (;
i < ixheaacd_drc_offset->n_flat_ls + (ixheaacd_drc_offset->lfac * 3);
i++) {
dest[i] =
ixheaacd_add32_sat((-src1[ixheaacd_drc_offset->n_long / 2 +
ixheaacd_drc_offset->n_flat_ls +
ixheaacd_drc_offset->lfac - i - 1] >>
(shiftp - fac_q)),
(*fac_data_out));
fac_data_out++;
}
for (; i < ixheaacd_drc_offset->n_long; i++) {
dest[i] = -src1[ixheaacd_drc_offset->n_long / 2 +
ixheaacd_drc_offset->n_flat_ls +
ixheaacd_drc_offset->lfac - i - 1] >>
(shiftp - fac_q);
}
return (fac_q);
} else {
memcpy(dest, over_lap, sizeof(WORD32) * (ixheaacd_drc_offset->n_flat_ls +
ixheaacd_drc_offset->lfac));
for (i = ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->lfac;
i < ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->n_trans_ls;
i++) {
dest[i] = ixheaacd_add32_sat(
(ixheaacd_mult32_sh1(-src1[ixheaacd_drc_offset->n_long / 2 +
ixheaacd_drc_offset->n_flat_ls +
ixheaacd_drc_offset->lfac - i - 1],
*win_fwd) >>
(shiftp - shift_olap)),
(*fac_data_out) >> (fac_q - shift_olap));
win_fwd++;
fac_data_out++;
}
for (;
i < ixheaacd_drc_offset->n_flat_ls + (ixheaacd_drc_offset->lfac * 3);
i++) {
dest[i] =
ixheaacd_add32_sat((-src1[ixheaacd_drc_offset->n_long / 2 +
ixheaacd_drc_offset->n_flat_ls +
ixheaacd_drc_offset->lfac - i - 1] >>
(shiftp - shift_olap)),
(*fac_data_out) >> (fac_q - shift_olap));
fac_data_out++;
}
for (; i < ixheaacd_drc_offset->n_long; i++) {
dest[i] = -src1[ixheaacd_drc_offset->n_long / 2 +
ixheaacd_drc_offset->n_flat_ls +
ixheaacd_drc_offset->lfac - i - 1] >>
(shiftp - shift_olap);
}
return (shift_olap);
}
} else {
if (shift_olap > shiftp) {
for (i = 0;
i < ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->lfac;
i++) {
dest[i] = over_lap[i] >> (shift_olap - shiftp);
}
for (i = ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->lfac;
i < ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->n_trans_ls;
i++) {
dest[i] = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(-src1[ixheaacd_drc_offset->n_long / 2 +
ixheaacd_drc_offset->n_flat_ls +
ixheaacd_drc_offset->lfac - i - 1],
*win_fwd),
(*fac_data_out) >> (fac_q - shiftp));
win_fwd++;
fac_data_out++;
}
for (;
i < ixheaacd_drc_offset->n_flat_ls + (ixheaacd_drc_offset->lfac * 3);
i++) {
dest[i] = ixheaacd_add32_sat(-src1[ixheaacd_drc_offset->n_long / 2 +
ixheaacd_drc_offset->n_flat_ls +
ixheaacd_drc_offset->lfac - i - 1],
(*fac_data_out) >> (fac_q - shiftp));
fac_data_out++;
}
for (; i < ixheaacd_drc_offset->n_long; i++) {
dest[i] = -src1[ixheaacd_drc_offset->n_long / 2 +
ixheaacd_drc_offset->n_flat_ls +
ixheaacd_drc_offset->lfac - i - 1];
}
return (shiftp);
} else {
memcpy(dest, over_lap, sizeof(WORD32) * (ixheaacd_drc_offset->n_flat_ls +
ixheaacd_drc_offset->lfac));
for (i = ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->lfac;
i < ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->n_trans_ls;
i++) {
dest[i] = ixheaacd_add32_sat(
(ixheaacd_mult32_sh1(-src1[ixheaacd_drc_offset->n_long / 2 +
ixheaacd_drc_offset->n_flat_ls +
ixheaacd_drc_offset->lfac - i - 1],
*win_fwd) >>
(shiftp - shift_olap)),
(*fac_data_out) >> (fac_q - shift_olap));
win_fwd++;
fac_data_out++;
}
for (;
i < ixheaacd_drc_offset->n_flat_ls + (ixheaacd_drc_offset->lfac * 3);
i++) {
dest[i] =
ixheaacd_add32_sat((-src1[ixheaacd_drc_offset->n_long / 2 +
ixheaacd_drc_offset->n_flat_ls +
ixheaacd_drc_offset->lfac - i - 1] >>
(shiftp - shift_olap)),
(*fac_data_out) >> (fac_q - shift_olap));
fac_data_out++;
}
for (; i < ixheaacd_drc_offset->n_long; i++) {
dest[i] = -src1[ixheaacd_drc_offset->n_long / 2 +
ixheaacd_drc_offset->n_flat_ls +
ixheaacd_drc_offset->lfac - i - 1] >>
(shiftp - shift_olap);
}
return (shift_olap);
}
}
}
WORD8 ixheaacd_windowing_long3(WORD32 *src1, const WORD32 *win_fwd,
WORD32 *over_lap, WORD32 *p_out_buffer,
const WORD32 *win_rev,
offset_lengths *ixheaacd_drc_offset,
WORD8 shiftp, WORD8 shift_olap) {
WORD32 i;
WORD32 *dest = p_out_buffer;
if (shiftp > shift_olap) {
memcpy(dest, over_lap, sizeof(FLOAT32) * ixheaacd_drc_offset->n_flat_ls);
for (i = ixheaacd_drc_offset->n_flat_ls;
i < ixheaacd_drc_offset->n_long / 2; i++) {
dest[i] = ixheaacd_add32_sat(
(ixheaacd_mult32_sh1(src1[i], *win_fwd) >> (shiftp - shift_olap)),
ixheaacd_mult32_sh1(over_lap[i], *win_rev));
win_fwd++;
win_rev--;
}
for (i = ixheaacd_drc_offset->n_long / 2;
i < ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->n_trans_ls;
i++) {
dest[i] = ixheaacd_add32_sat(
(ixheaacd_mult32_sh1(-src1[ixheaacd_drc_offset->n_long - i - 1],
*win_fwd) >>
(shiftp - shift_olap)),
ixheaacd_mult32_sh1(over_lap[i], *win_rev));
win_fwd++;
win_rev--;
}
for (; i < ixheaacd_drc_offset->n_long; i++) {
dest[i] =
-src1[ixheaacd_drc_offset->n_long - i - 1] >> (shiftp - shift_olap);
}
return (shift_olap);
} else {
for (i = 0; i < ixheaacd_drc_offset->n_flat_ls; i++) {
dest[i] = over_lap[i] >> (shift_olap - shiftp);
}
for (i = ixheaacd_drc_offset->n_flat_ls;
i < ixheaacd_drc_offset->n_long / 2; i++) {
dest[i] = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(src1[i], *win_fwd),
ixheaacd_mult32_sh1(over_lap[i], *win_rev) >> (shift_olap - shiftp));
win_fwd++;
win_rev--;
}
for (i = ixheaacd_drc_offset->n_long / 2;
i < ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->n_trans_ls;
i++) {
dest[i] = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(-src1[ixheaacd_drc_offset->n_long - i - 1],
*win_fwd),
ixheaacd_mult32_sh1(over_lap[i], *win_rev) >> (shift_olap - shiftp));
win_fwd++;
win_rev--;
}
for (; i < ixheaacd_drc_offset->n_long; i++) {
dest[i] = -src1[ixheaacd_drc_offset->n_long - i - 1];
}
return (shiftp);
}
}
VOID ixheaacd_windowing_short1(WORD32 *src1, WORD32 *src2, WORD32 *fp,
offset_lengths *ixheaacd_drc_offset,
WORD8 shiftp, WORD8 shift_olap) {
WORD32 i;
WORD32 *dest = fp;
if (shift_olap > shiftp) {
if (ixheaacd_drc_offset->n_short > ixheaacd_drc_offset->lfac) {
for (i = 0; i < ixheaacd_drc_offset->lfac; i++) {
dest[i] = dest[i] >> (shift_olap - shiftp);
}
for (i = ixheaacd_drc_offset->lfac; i < ixheaacd_drc_offset->n_short;
i++) {
dest[i] = ixheaacd_mult32_sh1(
-src1[ixheaacd_drc_offset->n_short - i - 1], src2[i]);
}
for (; i < ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->lfac;
i++) {
dest[i] = 0;
}
} else {
for (i = 0; i < ixheaacd_drc_offset->lfac; i++) {
dest[i] = dest[i] >> (shift_olap - shiftp);
}
for (i = ixheaacd_drc_offset->lfac;
i < ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->lfac;
i++) {
dest[i] = 0;
}
}
} else {
if (ixheaacd_drc_offset->n_short > ixheaacd_drc_offset->lfac) {
for (i = ixheaacd_drc_offset->lfac; i < ixheaacd_drc_offset->n_short;
i++) {
dest[i] = ixheaacd_mult32_sh1(
-src1[ixheaacd_drc_offset->n_short - i - 1], src2[i]) >>
(shiftp - shift_olap);
}
for (; i < ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->lfac;
i++) {
dest[i] = 0;
}
} else {
for (i = ixheaacd_drc_offset->lfac;
i < ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->lfac;
i++) {
dest[i] = 0;
}
}
}
}
VOID ixheaacd_windowing_short2(WORD32 *src1, WORD32 *win_fwd, WORD32 *fp,
offset_lengths *ixheaacd_drc_offset,
WORD8 shiftp, WORD8 shift_olap) {
WORD32 i;
WORD32 *win_rev = win_fwd + ixheaacd_drc_offset->n_short - 1;
if (shift_olap > shiftp) {
for (i = 0; i < ixheaacd_drc_offset->n_short / 2; i++) {
fp[i] = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(src1[i], *win_fwd),
(ixheaacd_mult32_sh1(fp[i], *win_rev) >> (shift_olap - shiftp)));
fp[ixheaacd_drc_offset->n_short - i - 1] = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(-src1[i], *win_rev),
(ixheaacd_mult32_sh1(fp[ixheaacd_drc_offset->n_short - i - 1],
*win_fwd) >>
(shift_olap - shiftp)));
win_fwd++;
win_rev--;
}
for (i = ixheaacd_drc_offset->n_short;
i < ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->n_short;
i++) {
fp[i] = 0;
}
} else {
for (i = 0; i < ixheaacd_drc_offset->n_short / 2; i++) {
fp[i] = ixheaacd_add32_sat(
(ixheaacd_mult32_sh1(src1[i], *win_fwd) >> (shiftp - shift_olap)),
ixheaacd_mult32_sh1(fp[i], *win_rev));
fp[ixheaacd_drc_offset->n_short - i - 1] = ixheaacd_add32_sat(
(ixheaacd_mult32_sh1(-src1[i], *win_rev) >> (shiftp - shift_olap)),
ixheaacd_mult32_sh1(fp[ixheaacd_drc_offset->n_short - i - 1],
*win_fwd));
win_fwd++;
win_rev--;
}
for (i = ixheaacd_drc_offset->n_short;
i < ixheaacd_drc_offset->n_flat_ls + ixheaacd_drc_offset->n_short;
i++) {
fp[i] = 0;
}
}
}
WORD8 ixheaacd_windowing_short3(WORD32 *src1, WORD32 *win_rev, WORD32 *fp,
WORD32 n_short, WORD8 shiftp,
WORD8 shift_olap) {
WORD32 i;
const WORD32 *win_fwd = win_rev - n_short + 1;
if (shift_olap > shiftp) {
for (i = 0; i < n_short / 2; i++) {
fp[i] = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(-src1[n_short / 2 - i - 1], *win_rev),
(fp[i] >> (shift_olap - shiftp)));
fp[n_short - i - 1] = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(-src1[n_short / 2 - i - 1], *win_fwd),
(fp[n_short - i - 1] >> (shift_olap - shiftp)));
win_rev--;
win_fwd++;
}
return (shiftp);
} else {
for (i = 0; i < n_short / 2; i++) {
fp[i] = ixheaacd_add32_sat(
(ixheaacd_mult32_sh1(-src1[n_short / 2 - i - 1], *win_rev) >>
(shiftp - shift_olap)),
fp[i]);
fp[n_short - i - 1] = ixheaacd_add32_sat(
(ixheaacd_mult32_sh1(-src1[n_short / 2 - i - 1], *win_fwd) >>
(shiftp - shift_olap)),
fp[n_short - i - 1]);
win_rev--;
win_fwd++;
}
return (shift_olap);
}
}
WORD8 ixheaacd_windowing_short4(WORD32 *src1, WORD32 *win_fwd, WORD32 *fp,
WORD32 *win_fwd1, WORD32 n_short, WORD32 flag,
WORD8 shiftp, WORD8 shift_olap,
WORD8 output_q) {
WORD32 i;
const WORD32 *win_rev = win_fwd + n_short - 1;
const WORD32 *win_rev1 = win_fwd1 - n_short + 1;
if (shift_olap > output_q) {
for (i = 0; i < n_short / 2; i++) {
fp[i] = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(src1[n_short / 2 + i], *win_fwd) >>
(shiftp - output_q),
fp[i]);
fp[n_short - i - 1] = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(-src1[n_short / 2 + i], *win_rev) >>
(shiftp - output_q),
fp[n_short - i - 1]);
win_fwd++;
win_rev--;
}
if (flag == 1) {
for (; i < n_short; i++) {
fp[i + n_short / 2] = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(-src1[n_short - i - 1], *win_fwd1) >>
(shiftp - output_q),
(fp[i + n_short / 2] >> (shift_olap - output_q)));
fp[3 * n_short - n_short / 2 - i - 1] = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(-src1[n_short - i - 1], *win_rev1) >>
(shiftp - output_q),
(fp[3 * n_short - n_short / 2 - i - 1] >> (shift_olap - output_q)));
win_fwd1--;
win_rev1++;
}
} else {
for (; i < n_short; i++) {
fp[i + n_short / 2] =
ixheaacd_add32_sat(-src1[n_short - i - 1] >> (shiftp - output_q),
fp[i + n_short / 2] >> (shift_olap - output_q));
fp[3 * n_short - n_short / 2 - i - 1] = ixheaacd_add32_sat(
-src1[n_short - i - 1] >> (shiftp - output_q),
fp[3 * n_short - n_short / 2 - i - 1] >> (shift_olap - output_q));
}
}
return (output_q);
} else {
for (i = 0; i < n_short / 2; i++) {
fp[i] = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(src1[n_short / 2 + i], *win_fwd) >>
(shiftp - shift_olap),
fp[i] >> (output_q - shift_olap));
fp[n_short - i - 1] = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(-src1[n_short / 2 + i], *win_rev) >>
(shiftp - shift_olap),
fp[n_short - i - 1]);
win_fwd++;
win_rev--;
}
if (flag == 1) {
for (; i < n_short; i++) {
fp[i + n_short / 2] = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(-src1[n_short - i - 1], *win_fwd1) >>
(shiftp - shift_olap),
fp[i + n_short / 2]);
fp[3 * n_short - n_short / 2 - i - 1] = ixheaacd_add32_sat(
ixheaacd_mult32_sh1(-src1[n_short - i - 1], *win_rev1) >>
(shiftp - shift_olap),
fp[3 * n_short - n_short / 2 - i - 1]);
win_fwd1--;
win_rev1++;
}
} else {
for (; i < n_short; i++) {
fp[i + n_short / 2] =
ixheaacd_add32_sat(-src1[n_short - i - 1] >> (shiftp - shift_olap),
fp[i + n_short / 2]);
fp[3 * n_short - n_short / 2 - i - 1] =
ixheaacd_add32_sat(-src1[n_short - i - 1] >> (shiftp - shift_olap),
fp[3 * n_short - n_short / 2 - i - 1]);
}
}
return (shift_olap);
}
}
VOID ixheaacd_scale_down(WORD32 *dest, WORD32 *src, WORD32 len, WORD8 shift1,
WORD8 shift2) {
WORD32 i;
if (shift1 > shift2) {
for (i = 0; i < len; i++) {
*dest = *src >> (shift1 - shift2);
src++;
dest++;
}
} else {
for (i = 0; i < len; i++) {
*dest = *src << (shift2 - shift1);
src++;
dest++;
}
}
}