rvoip-codec-core 0.2.2

G.711 and optional G.729A/G.729AB audio codec implementation for RVOIP
Documentation 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81

//! Provenance: LPC/LSP analysis derived from ITU G.729 LPC conversion and recursion routines.
//! Q-format: Correlations and predictor coefficients use Q12/Q13/Q15 fixed-point domains.

use crate::codecs::g729::impls::constants::NC;
use crate::codecs::g729::impls::dsp::arith::extract_h;
use crate::codecs::g729::impls::dsp::arith32::{l_mac, l_msu, l_mult};
use crate::codecs::g729::impls::dsp::oper32::l_extract;
use crate::codecs::g729::impls::dsp::oper32::mpy_32_16;
use crate::codecs::g729::impls::dsp::shift::l_shl;
use crate::codecs::g729::impls::dsp::types::{DspContext, Word16};

#[inline(always)]
fn w(v: i16) -> Word16 {
    Word16(v)
}

pub(crate) fn chebps_11(x: i16, f: &[i16; NC + 1]) -> i16 {
    let mut ctx = DspContext::default();

    let mut b2_h = 256i16;
    let mut b2_l = 0i16;

    let mut t0 = l_mult(&mut ctx, w(x), w(512));
    t0 = l_mac(&mut ctx, t0, w(f[1]), w(4096));
    let (mut b1_h, mut b1_l) = l_extract(t0);

    let mut i = 2usize;
    while i < NC {
        t0 = mpy_32_16(b1_h, b1_l, w(x));
        t0 = l_shl(&mut ctx, t0, 1);
        t0 = l_mac(&mut ctx, t0, w(b2_h), w(-32768));
        t0 = l_msu(&mut ctx, t0, w(b2_l), w(1));
        t0 = l_mac(&mut ctx, t0, w(f[i]), w(4096));
        let (b0_h, b0_l) = l_extract(t0);
        b2_h = b1_h.0;
        b2_l = b1_l.0;
        b1_h = b0_h;
        b1_l = b0_l;
        i += 1;
    }

    t0 = mpy_32_16(b1_h, b1_l, w(x));
    t0 = l_mac(&mut ctx, t0, w(b2_h), w(-32768));
    t0 = l_msu(&mut ctx, t0, w(b2_l), w(1));
    t0 = l_mac(&mut ctx, t0, w(f[NC]), w(2048));
    t0 = l_shl(&mut ctx, t0, 6);
    extract_h(t0).0
}

pub(crate) fn chebps_10(x: i16, f: &[i16; NC + 1]) -> i16 {
    let mut ctx = DspContext::default();

    let mut b2_h = 128i16;
    let mut b2_l = 0i16;

    let mut t0 = l_mult(&mut ctx, w(x), w(256));
    t0 = l_mac(&mut ctx, t0, w(f[1]), w(4096));
    let (mut b1_h, mut b1_l) = l_extract(t0);

    let mut i = 2usize;
    while i < NC {
        t0 = mpy_32_16(b1_h, b1_l, w(x));
        t0 = l_shl(&mut ctx, t0, 1);
        t0 = l_mac(&mut ctx, t0, w(b2_h), w(-32768));
        t0 = l_msu(&mut ctx, t0, w(b2_l), w(1));
        t0 = l_mac(&mut ctx, t0, w(f[i]), w(4096));
        let (b0_h, b0_l) = l_extract(t0);
        b2_h = b1_h.0;
        b2_l = b1_l.0;
        b1_h = b0_h;
        b1_l = b0_l;
        i += 1;
    }

    t0 = mpy_32_16(b1_h, b1_l, w(x));
    t0 = l_mac(&mut ctx, t0, w(b2_h), w(-32768));
    t0 = l_msu(&mut ctx, t0, w(b2_l), w(1));
    t0 = l_mac(&mut ctx, t0, w(f[NC]), w(2048));
    t0 = l_shl(&mut ctx, t0, 7);
    extract_h(t0).0
}