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
82
83
84
85
86
87
88
89
90
91
92
93

/*
Copyright 2016 Martin Buck
This file is part of rust-3d.
rust-3d is free software: you can redistribute it and/or modify
it under the terms of the GNU Lesser General Public License as published by
the Free Software Foundation, either version 3 of the License, or
(at your option) any later version.
rust-3d is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
GNU Lesser General Public License for more details.
You should have received a copy of the GNU Lesser General Public License
along with rust-3d.  If not, see <http://www.gnu.org/licenses/>.
*/

//! CompressedPointCloud3D

extern crate num;

use self::num::traits::PrimInt;
use self::num::traits::Unsigned;

use prelude::*;
use compressed_point_3d::*;

#[derive (Debug, Clone, PartialEq, PartialOrd)]
/// CompressedPointCloud3D
pub struct CompressedPointCloud3D<T> where
    T: Unsigned + PrimInt {

    pub start: Point3D,
    pub unitsizex: f64,
    pub unitsizey: f64,
    pub unitsizez: f64,
    pub data: Vec<CompressedPoint3D<T>>
}


impl<T> CompressedPointCloud3D<T> where
    T: Unsigned + PrimInt {
    /// Creates a new CompressedPointCloud3D from a normal point cloud
    pub fn compress<P>(pc: &PointCloud3D<P>) -> Result<CompressedPointCloud3D<T>> where
        P: Is3D {

        let bb = pc.bounding_box()?;

        let rangex = (bb.max_p().x - bb.min_p().x).abs();
        let rangey = (bb.max_p().y - bb.min_p().y).abs();
        let rangez = (bb.max_p().z - bb.min_p().z).abs();

        let maxval = T::max_value().to_f64().ok_or(ErrorKind::NumberConversionError)?;
        let unitsizex = rangex / maxval;
        let unitsizey = rangey / maxval;
        let unitsizez = rangez / maxval;

        let mut data = Vec::new();

        for p in &pc.data {
            let distx = p.x() - bb.min_p().x;
            let disty = p.y() - bb.min_p().y;
            let distz = p.z() - bb.min_p().z;

            let unitsx = T::from(distx / unitsizex).ok_or(ErrorKind::NumberConversionError)?;
            let unitsy = T::from(disty / unitsizey).ok_or(ErrorKind::NumberConversionError)?;
            let unitsz = T::from(distz / unitsizez).ok_or(ErrorKind::NumberConversionError)?;

            data.push(CompressedPoint3D{
                unitsx,
                unitsy,
                unitsz
            })
        }
        Ok(CompressedPointCloud3D::<T>{start: bb.min_p(), unitsizex, unitsizey, unitsizez, data})
    }

    /// Creates a new point cloud from this
    pub fn decompress<P>(&self) -> PointCloud3D<P> where
        P: Is3D + IsBuildable3D {

        let mut pc = PointCloud3D::new();

        for p in &self.data {
            if let (Some(unitsxf), Some(unitsyf), Some(unitszf)) = (p.unitsx.to_f64(), p.unitsy.to_f64(), p.unitsz.to_f64()) {
                pc.push(P::new(
                    self.start.x + (self.unitsizex * unitsxf),
                    self.start.y + (self.unitsizey * unitsyf),
                    self.start.z + (self.unitsizez * unitszf)
                ));
            }
        }
        pc
    }
}