mini_sbc 0.1.7

Bluetooth audio SBC decoder
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

use crate::sbc::FILTER_ORDER;
use crate::sbc::{Channels, Subbands, ValidChannels, ValidSubbands};
use core::fmt::{Debug, Formatter};

pub struct FilterState<const CHANNELS: usize, const SUBBANDS: usize>
where
    Channels<CHANNELS>: ValidChannels,
    Subbands<SUBBANDS>: ValidSubbands,
{
    filter_state: [[[i32; FILTER_ORDER]; SUBBANDS]; CHANNELS],
    step: u8,
}

impl<const CHANNELS: usize, const SUBBANDS: usize> FilterState<CHANNELS, SUBBANDS>
where
    Channels<CHANNELS>: ValidChannels,
    Subbands<SUBBANDS>: ValidSubbands,
{
    pub const fn new() -> Self {
        Self {
            filter_state: [[[0; FILTER_ORDER]; SUBBANDS]; CHANNELS],
            step: 0,
        }
    }

    pub fn filter(&mut self, s: &[[i32; SUBBANDS]; CHANNELS]) -> [[i16; SUBBANDS]; CHANNELS] {
        let step = self.step as usize;

        let mut o = [[0; SUBBANDS]; CHANNELS];
        for ch in 0..CHANNELS {
            <Subbands<SUBBANDS> as ValidSubbands>::decode16(
                step,
                &mut self.filter_state[ch],
                &s[ch],
                &mut o[ch],
            );
        }

        if step + 1 == FILTER_ORDER {
            self.step = 0;
        } else {
            self.step = (step + 1) as u8;
        }
        o
    }
}

impl<const CHANNELS: usize, const SUBBANDS: usize> Debug for FilterState<CHANNELS, SUBBANDS>
where
    Channels<CHANNELS>: ValidChannels,
    Subbands<SUBBANDS>: ValidSubbands,
{
    fn fmt(&self, f: &mut Formatter<'_>) -> core::fmt::Result {
        let mut s = f.debug_struct("Decoder");
        s.field("CHANNELS", &CHANNELS);
        s.field("SUBBANDS", &SUBBANDS);
        s.field("filter_state", &self.filter_state);
        s.field("step", &self.step);
        s.finish()
    }
}