From 5248831232fa22a1f3d6515f7f6c7bee8994faf2 Mon Sep 17 00:00:00 2001
From: metamuffin <metamuffin@disroot.org>
Date: Mon, 21 Nov 2022 16:59:50 +0100
Subject: unify repos

---
 dhwt-codec/src/trim.rs | 36 ++++++++++++++++++++++++++++++++++++
 1 file changed, 36 insertions(+)
 create mode 100644 dhwt-codec/src/trim.rs

(limited to 'dhwt-codec/src/trim.rs')

diff --git a/dhwt-codec/src/trim.rs b/dhwt-codec/src/trim.rs
new file mode 100644
index 0000000..85a920a
--- /dev/null
+++ b/dhwt-codec/src/trim.rs
@@ -0,0 +1,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];
+    }
+}
-- 
cgit v1.2.3-70-g09d2