dhwt-codec/src/trim.rs


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

use crate::io::{Value, TWO, ZERO};
use std::ops::{Index, IndexMut};

pub fn trim<X: Index<usize, Output = Value> + IndexMut<usize, Output = Value>>(
    size: usize,
    a: &mut X,
) {
    let half = size / 2;
    let quarter = size / 4;
    for i in 0..(size / 2 / 4) {
        let hi = half + i * 4;
        let qi = quarter + i * 2;
        a[qi] = (a[qi + 0] + a[qi + 1]) / TWO;
        a[qi + 1] = (a[hi + 0] + a[hi + 1] + a[hi + 2] + a[hi + 3]) / (TWO * TWO);
    }
    for i in half..size {
        a[i] = ZERO;
    }
}

pub fn untrim<X: Index<usize, Output = Value> + IndexMut<usize, Output = Value>>(
    size: usize,
    a: &mut X,
) {
    let half = size / 2;
    let quarter = size / 4;
    for i in 0..(size / 2 / 4) {
        let hi = half + i * 4;
        let qi = quarter + i * 2;
        a[hi + 0] = a[qi + 1];
        a[hi + 1] = a[qi + 1];
        a[hi + 2] = a[qi + 1];
        a[hi + 3] = a[qi + 1];
        a[qi + 1] = a[qi];
    }
}