-
Notifications
You must be signed in to change notification settings - Fork 432
/
MortonOrderFilter.cpp
125 lines (107 loc) · 4.08 KB
/
MortonOrderFilter.cpp
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
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
/******************************************************************************
* Copyright (c) 2014, Bradley J Chambers (brad.chambers@gmail.com)
*
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following
* conditions are met:
*
* * Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* * Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in
* the documentation and/or other materials provided
* with the distribution.
* * Neither the name of Hobu, Inc. or Flaxen Geo Consulting nor the
* names of its contributors may be used to endorse or promote
* products derived from this software without specific prior
* written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
* OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
* OF SUCH DAMAGE.
****************************************************************************/
#include "MortonOrderFilter.hpp"
#include <iostream>
#include <limits>
#include <map>
namespace pdal
{
static PluginInfo const s_info = PluginInfo(
"filters.mortonorder",
"Morton or z-order sorting of points. See http://en.wikipedia.org/wiki/Z-order_curve for more detail.",
"http://pdal.io/stages/filters.mortonorder.html" );
CREATE_STATIC_PLUGIN(1, 0, MortonOrderFilter, Filter, s_info)
std::string MortonOrderFilter::getName() const { return s_info.name; }
Options MortonOrderFilter::getDefaultOptions()
{
Options options;
return options;
}
//This used to be a lambda, but the VS compiler exploded, I guess.
typedef std::pair<double, double> Coord;
namespace
{
bool less_msb(const int& x, const int& y)
{
return x < y && x < (x ^ y);
};
class CmpZOrder
{
public:
bool operator()(const Coord& c1, const Coord& c2) const
{
int a[2] = {(int)(c1.first * INT_MAX), (int)(c1.second * INT_MAX)};
int b[2] = {(int)(c2.first * INT_MAX), (int)(c2.second * INT_MAX)};
int j = 0;
int x = 0;
for (int k = 0; k < 2; k++)
{
int y = a[k] ^ b[k];
if (less_msb(x, y))
{
j = k;
x = y;
}
}
return (a[j] - b[j]) < 0;
};
};
}
PointViewSet MortonOrderFilter::run(PointViewPtr inView)
{
PointViewSet viewSet;
if (!inView->size())
return viewSet;
CmpZOrder compare;
std::multimap<Coord, PointId, CmpZOrder> sorted(compare);
BOX3D const& buffer_bounds = inView->calculateBounds();
double xrange = buffer_bounds.maxx - buffer_bounds.minx;
double yrange = buffer_bounds.maxy - buffer_bounds.miny;
for (PointId idx = 0; idx < inView->size(); idx++)
{
double xpos = (inView->getFieldAs<double>(Dimension::Id::X, idx) - buffer_bounds.minx) / xrange;
double ypos = (inView->getFieldAs<double>(Dimension::Id::Y, idx) - buffer_bounds.miny) / yrange;
Coord loc(xpos, ypos);
sorted.insert(std::make_pair(loc, idx));
}
PointViewPtr outView = inView->makeNew();
std::multimap<Coord, PointId, CmpZOrder>::iterator pos;
for (pos = sorted.begin(); pos != sorted.end(); ++pos)
{
outView->appendPoint(*inView, pos->second);
}
viewSet.insert(outView);
return viewSet;
}
} // pdal