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
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
|
// Boost.Geometry (aka GGL, Generic Geometry Library)
// Copyright (c) 2007-2012 Barend Gehrels, Amsterdam, the Netherlands.
// Copyright (c) 2008-2012 Bruno Lalande, Paris, France.
// Copyright (c) 2009-2012 Mateusz Loskot, London, UK.
// Parts of Boost.Geometry are redesigned from Geodan's Geographic Library
// (geolib/GGL), copyright (c) 1995-2010 Geodan, Amsterdam, the Netherlands.
// Use, modification and distribution is subject to the Boost Software License,
// Version 1.0. (See accompanying file LICENSE_1_0.txt or copy at
// http://www.boost.org/LICENSE_1_0.txt)
#ifndef BOOST_GEOMETRY_STRATEGIES_TRANSFORM_MAP_TRANSFORMER_HPP
#define BOOST_GEOMETRY_STRATEGIES_TRANSFORM_MAP_TRANSFORMER_HPP
#include <cstddef>
#include <boost/geometry/strategies/transform/matrix_transformers.hpp>
namespace boost { namespace geometry
{
// Silence warning C4127: conditional expression is constant
#if defined(_MSC_VER)
#pragma warning(push)
#pragma warning(disable : 4127)
#endif
namespace strategy { namespace transform
{
/*!
\brief Transformation strategy to map from one to another Cartesian coordinate system
\ingroup strategies
\tparam Mirror if true map is mirrored upside-down (in most cases pixels
are from top to bottom, while map is from bottom to top)
*/
template
<
typename CalculationType,
std::size_t Dimension1,
std::size_t Dimension2,
bool Mirror = false,
bool SameScale = true
>
class map_transformer
: public ublas_transformer<CalculationType, Dimension1, Dimension2>
{
typedef boost::numeric::ublas::matrix<CalculationType> M;
public :
template <typename B, typename D>
explicit inline map_transformer(B const& box, D const& width, D const& height)
{
set_transformation(
get<min_corner, 0>(box), get<min_corner, 1>(box),
get<max_corner, 0>(box), get<max_corner, 1>(box),
width, height);
}
template <typename W, typename D>
explicit inline map_transformer(W const& wx1, W const& wy1, W const& wx2, W const& wy2,
D const& width, D const& height)
{
set_transformation(wx1, wy1, wx2, wy2, width, height);
}
private :
template <typename W, typename P, typename S>
inline void set_transformation_point(W const& wx, W const& wy,
P const& px, P const& py,
S const& scalex, S const& scaley)
{
// Translate to a coordinate system centered on world coordinates (-wx, -wy)
M t1(3,3);
t1(0,0) = 1; t1(0,1) = 0; t1(0,2) = -wx;
t1(1,0) = 0; t1(1,1) = 1; t1(1,2) = -wy;
t1(2,0) = 0; t1(2,1) = 0; t1(2,2) = 1;
// Scale the map
M s(3,3);
s(0,0) = scalex; s(0,1) = 0; s(0,2) = 0;
s(1,0) = 0; s(1,1) = scaley; s(1,2) = 0;
s(2,0) = 0; s(2,1) = 0; s(2,2) = 1;
// Translate to a coordinate system centered on the specified pixels (+px, +py)
M t2(3, 3);
t2(0,0) = 1; t2(0,1) = 0; t2(0,2) = px;
t2(1,0) = 0; t2(1,1) = 1; t2(1,2) = py;
t2(2,0) = 0; t2(2,1) = 0; t2(2,2) = 1;
// Calculate combination matrix in two steps
this->m_matrix = boost::numeric::ublas::prod(s, t1);
this->m_matrix = boost::numeric::ublas::prod(t2, this->m_matrix);
}
template <typename W, typename D>
void set_transformation(W const& wx1, W const& wy1, W const& wx2, W const& wy2,
D const& width, D const& height)
{
D px1 = 0;
D py1 = 0;
D px2 = width;
D py2 = height;
// Get the same type, but at least a double
typedef typename select_most_precise<D, double>::type type;
// Calculate appropriate scale, take min because whole box must fit
// Scale is in PIXELS/MAPUNITS (meters)
W wdx = wx2 - wx1;
W wdy = wy2 - wy1;
type sx = (px2 - px1) / boost::numeric_cast<type>(wdx);
type sy = (py2 - py1) / boost::numeric_cast<type>(wdy);
if (SameScale)
{
type scale = (std::min)(sx, sy);
sx = scale;
sy = scale;
}
// Calculate centerpoints
W wtx = wx1 + wx2;
W wty = wy1 + wy2;
W two = 2;
W wmx = wtx / two;
W wmy = wty / two;
type pmx = (px1 + px2) / 2.0;
type pmy = (py1 + py2) / 2.0;
set_transformation_point(wmx, wmy, pmx, pmy, sx, sy);
if (Mirror)
{
// Mirror in y-direction
M m(3,3);
m(0,0) = 1; m(0,1) = 0; m(0,2) = 0;
m(1,0) = 0; m(1,1) = -1; m(1,2) = 0;
m(2,0) = 0; m(2,1) = 0; m(2,2) = 1;
// Translate in y-direction such that it fits again
M y(3, 3);
y(0,0) = 1; y(0,1) = 0; y(0,2) = 0;
y(1,0) = 0; y(1,1) = 1; y(1,2) = height;
y(2,0) = 0; y(2,1) = 0; y(2,2) = 1;
// Calculate combination matrix in two steps
this->m_matrix = boost::numeric::ublas::prod(m, this->m_matrix);
this->m_matrix = boost::numeric::ublas::prod(y, this->m_matrix);
}
}
};
}} // namespace strategy::transform
#if defined(_MSC_VER)
#pragma warning(pop)
#endif
}} // namespace boost::geometry
#endif // BOOST_GEOMETRY_STRATEGIES_TRANSFORM_MAP_TRANSFORMER_HPP
|
