scaler initial work

[nihav.git] / nihav-core / src / scale / scale.rs

diff --git a/nihav-core/src/scale/scale.rs b/nihav-core/src/scale/scale.rs
new file mode 100644 (file)
index 0000000..197b7c4
--- /dev/null
+++ b/nihav-core/src/scale/scale.rs
@@ -0,0 +1,58 @@
+use super::*;
+use super::kernel::Kernel;
+
+struct NNResampler {}
+
+impl NNResampler {
+    fn new() -> Self { Self{} }
+}
+
+macro_rules! scale_loop {
+    ($sbuf:expr, $dbuf:expr) => {
+            let fmt = $sbuf.get_info().get_format();
+            let ncomp = fmt.get_num_comp();
+            for comp in 0..ncomp {
+                let istride = $sbuf.get_stride(comp);
+                let dstride = $dbuf.get_stride(comp);
+                let (sw, sh) = $sbuf.get_dimensions(comp);
+                let (dw, dh) = $dbuf.get_dimensions(comp);
+                let ioff = $sbuf.get_offset(comp);
+                let mut doff = $dbuf.get_offset(comp);
+                let src = $sbuf.get_data();
+                let dst = $dbuf.get_data_mut().unwrap();
+                for y in 0..dh {
+                    let sy = y * sh / dh;
+                    let soff = ioff + sy * istride;
+                    for x in 0..dw {
+                        let sx = x * sw / dw;
+                        dst[doff + x] = src[soff + sx];
+                    }
+                    doff += dstride;
+                }
+            }
+    };
+}
+
+impl Kernel for NNResampler {
+    fn init(&mut self, in_fmt: &ScaleInfo, dest_fmt: &ScaleInfo) -> ScaleResult<NABufferType> {
+        let res = alloc_video_buffer(NAVideoInfo::new(dest_fmt.width, dest_fmt.height, false, in_fmt.fmt), 3);
+        if res.is_err() { return Err(ScaleError::AllocError); }
+        Ok(res.unwrap())
+    }
+    fn process(&mut self, pic_in: &NABufferType, pic_out: &mut NABufferType) {
+        if let (Some(ref sbuf), Some(ref mut dbuf)) = (pic_in.get_vbuf(), pic_out.get_vbuf()) {
+            scale_loop!(sbuf, dbuf);
+        } else if let (Some(ref sbuf), Some(ref mut dbuf)) = (pic_in.get_vbuf16(), pic_out.get_vbuf16()) {
+            scale_loop!(sbuf, dbuf);
+        } else if let (Some(ref sbuf), Some(ref mut dbuf)) = (pic_in.get_vbuf32(), pic_out.get_vbuf32()) {
+            scale_loop!(sbuf, dbuf);
+        } else {
+            unreachable!();
+        }
+    }
+}
+
+pub fn create_scale() -> Box<Kernel> {
+    Box::new(NNResampler::new())
+}
+