#include "avcodec.h"
#include "acelp_filters.h"
-#define FRAC_BITS 13
-#include "mathops.h"
-const int16_t ff_acelp_interp_filter[61] =
-{ /* (0.15) */
+const int16_t ff_acelp_interp_filter[61] = { /* (0.15) */
29443, 28346, 25207, 20449, 14701, 8693,
3143, -1352, -4402, -5865, -5850, -4673,
-2783, -672, 1211, 2536, 3130, 2991,
0,
};
-void ff_acelp_interpolate(
- int16_t* out,
- const int16_t* in,
- const int16_t* filter_coeffs,
- int precision,
- int pitch_delay_frac,
- int filter_length,
- int length)
+void ff_acelp_interpolate(int16_t* out, const int16_t* in,
+ const int16_t* filter_coeffs, int precision,
+ int frac_pos, int filter_length, int length)
{
int n, i;
assert(pitch_delay_frac >= 0 && pitch_delay_frac < precision);
- for(n=0; n<length; n++)
- {
+ for (n = 0; n < length; n++) {
int idx = 0;
int v = 0x4000;
- for(i=0; i<filter_length;)
- {
+ for (i = 0; i < filter_length;) {
/* The reference G.729 and AMR fixed point code performs clipping after
each of the two following accumulations.
v += R(n-i)*ff_acelp_interp_filter(t+6i)
v += R(n+i+1)*ff_acelp_interp_filter(6-t+6i) */
- v += in[n + i] * filter_coeffs[idx + pitch_delay_frac];
+ v += in[n + i] * filter_coeffs[idx + frac_pos];
idx += precision;
i++;
- v += in[n - i] * filter_coeffs[idx - pitch_delay_frac];
+ v += in[n - i] * filter_coeffs[idx - frac_pos];
}
- out[n] = av_clip_int16(v >> 15);
+ if (av_clip_int16(v >> 15) != (v >> 15))
+ av_log(NULL, AV_LOG_WARNING, "overflow that would need cliping in ff_acelp_interpolate()\n");
+ out[n] = v >> 15;
}
}
-void ff_acelp_convolve_circ(
- int16_t* fc_out,
- const int16_t* fc_in,
- const int16_t* filter,
- int subframe_size)
-{
- int i, k;
-
- memset(fc_out, 0, subframe_size * sizeof(int16_t));
-
- /* Since there are few pulses over an entire subframe (i.e. almost
- all fc_in[i] are zero) it is faster to swap two loops and process
- non-zero samples only. */
- for(i=0; i<subframe_size; i++)
- {
- if(fc_in[i])
- {
- for(k=0; k<i; k++)
- fc_out[k] += (fc_in[i] * filter[subframe_size + k - i]) >> 15;
-
- for(k=i; k<subframe_size; k++)
- fc_out[k] += (fc_in[i] * filter[k - i]) >> 15;
- }
- }
-}
-int ff_acelp_lp_synthesis_filter(
- int16_t *out,
- const int16_t* filter_coeffs,
- const int16_t* in,
- int buffer_length,
- int filter_length,
- int stop_on_overflow,
- int rounder)
+void ff_acelp_high_pass_filter(int16_t* out, int hpf_f[2],
+ const int16_t* in, int length)
{
- int i,n;
-
- // These two lines are to avoid a -1 subtraction in the main loop
- filter_length++;
- filter_coeffs--;
+ int i;
+ int tmp;
- for(n=0; n<buffer_length; n++)
- {
- int sum = rounder;
- for(i=1; i<filter_length; i++)
- sum -= filter_coeffs[i] * out[n-i];
+ for (i = 0; i < length; i++) {
+ tmp = (hpf_f[0]* 15836LL) >> 13;
+ tmp += (hpf_f[1]* -7667LL) >> 13;
+ tmp += 7699 * (in[i] - 2*in[i-1] + in[i-2]);
- sum = (sum >> 12) + in[n];
+ /* With "+0x800" rounding, clipping is needed
+ for ALGTHM and SPEECH tests. */
+ out[i] = av_clip_int16((tmp + 0x800) >> 12);
- if(sum + 0x8000 > 0xFFFFU)
- {
- if(stop_on_overflow)
- return 1;
- sum = (sum >> 31) ^ 32767;
- }
- out[n] = sum;
+ hpf_f[1] = hpf_f[0];
+ hpf_f[0] = tmp;
}
-
- return 0;
-}
-
-void ff_acelp_weighted_filter(
- int16_t *out,
- const int16_t* in,
- const int16_t *weight_pow,
- int filter_length)
-{
- int n;
- for(n=0; n<filter_length; n++)
- out[n] = (in[n] * weight_pow[n] + 0x4000) >> 15; /* (3.12) = (0.15) * (3.12) with rounding */
}
-void ff_acelp_high_pass_filter(
- int16_t* out,
- int hpf_f[2],
- const int16_t* in,
- int length)
+void ff_acelp_apply_order_2_transfer_function(float *buf,
+ const float zero_coeffs[2],
+ const float pole_coeffs[2],
+ float gain, float mem[2], int n)
{
int i;
- int tmp;
-
- for(i=0; i<length; i++)
- {
- tmp = MULL(hpf_f[0], 15836); /* (14.13) = (13.13) * (1.13) */
- tmp += MULL(hpf_f[1], -7667); /* (13.13) = (13.13) * (0.13) */
- tmp += 7699 * (in[i] - 2*in[i-1] + in[i-2]); /* (14.13) = (0.13) * (14.0) */
+ float tmp;
- out[i] = av_clip_int16((tmp + 0x800) >> 12); /* (15.0) = 2 * (13.13) = (14.13) */
+ for (i = 0; i < n; i++) {
+ tmp = gain * buf[i] - pole_coeffs[0] * mem[0] - pole_coeffs[1] * mem[1];
+ buf[i] = tmp + zero_coeffs[0] * mem[0] + zero_coeffs[1] * mem[1];
- hpf_f[1] = hpf_f[0];
- hpf_f[0] = tmp;
+ mem[1] = mem[0];
+ mem[0] = tmp;
}
}