Debian Codegraph @

plugins/core/Standard/qRANSAC_SD/extern/RANSAC_SD/LowStretchSphereParametrization.cpp

raw
1 #include "LowStretchSphereParametrization.h"
2 #include "Bitmap.h"
3
4 #if !defined(_WIN32) && !defined(WIN32)
5 #include <unistd.h>
6 #endif
7
8 LowStretchSphereParametrization::LowStretchSphereParametrization(
9 const Sphere &sphere)
10 : m_sphere(&sphere)
11 {
12 m_frame.Canonical();
13 }
14
15 void LowStretchSphereParametrization::Shape(const Sphere &sphere)
16 {
17 m_sphere = &sphere;
18 m_frame.Canonical();
19 }
20
21 void LowStretchSphereParametrization::WrapComponents(const GfxTL::AABox< GfxTL::Vector2Df > &bbox,
22 float epsilon, size_t uextent, size_t vextent,
23 MiscLib::Vector< int > *componentImg,
24 MiscLib::Vector< std::pair< int, size_t > > *labels) const
25 {
26 // wraps are necessary only in v direction
27 // relabel the components
28 MiscLib::Vector< std::pair< int, size_t > > tempLabels(*labels);
29 // wrap along v
30 float vstartPrev, vendPrev, vstart = 0, vend = 0, vstartNext = 0, vendNext = 0;
31 size_t vsPrev, vePrev, vs = 0, ve = 0, vsNext = 0, veNext = 0;
32 float uangle = (bbox.Min()[0] + .5f * epsilon) / m_sphere->Radius();
33 float radius = std::sin(uangle) * m_sphere->Radius();
34 vstartNext = float(-M_PI) * radius;
35 vendNext = float(M_PI) * radius;
36 vsNext = std::min(vextent - 1, (size_t)std::max((intptr_t)0,
37 (intptr_t)((vstartNext - bbox.Min()[1]) / epsilon)));
38 veNext = (size_t)std::max((intptr_t)0, std::min((intptr_t)vextent - 1,
39 (intptr_t)((vendNext - bbox.Min()[1]) / epsilon)));
40 for(size_t u = 0; u < uextent; ++u)
41 {
42 vstartPrev = vstart; vstart = vstartNext;
43 vendPrev = vend; vend = vendNext;
44 vsPrev = vs; vs = vsNext;
45 vePrev = ve; ve = veNext;
46 // determine starting position in the next column
47 if(u < uextent - 1)
48 {
49 float uangleNext = ((u + 1.5f) * epsilon + bbox.Min()[0]) / m_sphere->Radius();
50 float radiusNext = std::sin(uangleNext) * m_sphere->Radius();
51 vstartNext = float(-M_PI) * radiusNext;
52 vendNext = float(M_PI) * radiusNext;
53 vsNext = std::min(vextent - 1, (size_t)std::max((intptr_t)0,
54 (intptr_t)((vstartNext - bbox.Min()[1]) / epsilon)));
55 veNext = (size_t)std::max((intptr_t)0, std::min((intptr_t)vextent - 1,
56 (intptr_t)((vendNext - bbox.Min()[1]) / epsilon)));
57 }
58 if(vstart <= bbox.Min()[1] - epsilon
59 || vend >= bbox.Max()[1] + epsilon
60 || !(*componentImg)[vs * uextent + u])
61 continue;
62 // check the three neighbors on the other side
63 if((*componentImg)[ve * uextent + u])
64 AssociateLabel((*componentImg)[vs * uextent + u],
65 (*componentImg)[ve * uextent + u], &tempLabels);
66 if(u > 0
67 && vstartPrev > bbox.Min()[1] - epsilon
68 && vendPrev < bbox.Min()[1] + epsilon
69 && (*componentImg)[vePrev * uextent + u - 1])
70 AssociateLabel((*componentImg)[vs * uextent + u],
71 (*componentImg)[vePrev * uextent + u - 1], &tempLabels);
72 if(u < uextent - 1
73 && vstartNext > bbox.Min()[1] - epsilon
74 && vendNext < bbox.Min()[1] + epsilon
75 && (*componentImg)[veNext * uextent + u + 1])
76 AssociateLabel((*componentImg)[vs * uextent + u],
77 (*componentImg)[veNext * uextent + u + 1], &tempLabels);
78 }
79
80 // condense labels
81 for(int i = static_cast<int>(tempLabels.size()) - 1; i > 0; --i)
82 tempLabels[i].first = ReduceLabel(i, tempLabels);
83 MiscLib::Vector< int > condensed(tempLabels.size());
84 labels->clear();
85 labels->reserve(condensed.size());
86 int count = 0;
87 for(size_t i = 0; i < tempLabels.size(); ++i)
88 if(i == tempLabels[i].first)
89 {
90 labels->push_back(std::make_pair(count, tempLabels[i].second));
91 condensed[i] = count;
92 ++count;
93 }
94 else
95 (*labels)[condensed[tempLabels[i].first]].second
96 += tempLabels[i].second;
97 // set new component ids
98 for(size_t i = 0; i < componentImg->size(); ++i)
99 (*componentImg)[i] =
100 condensed[tempLabels[(*componentImg)[i]].first];
101 }
102
103 size_t LowStretchSphereParametrization::SerializedSize()
104 {
105 return sizeof(GfxTL::Frame< 3, float >::PointType) + sizeof(float);
106 }
107
108 void LowStretchSphereParametrization::Serialize(std::ostream *o, bool binary) const
109 {
110 // defer rotation from frame
111 GfxTL::Frame< 3, float > nframe;
112 nframe.FromNormal(m_frame[2]);
113 GfxTL::VectorXD< 2, float > t;
114 nframe.ToTangent(m_frame[0], &t);
115 for(unsigned int i = 0; i < 2; ++i)
116 t[i] = GfxTL::Math< float >::Clamp(t[i], -1, 1);
117 float angle = std::atan2(t[1], t[0]);
118 // write normal and dummy rotation
119 if(binary)
120 {
121 o->write((char *)&m_frame[2],
122 sizeof(GfxTL::Frame< 3, float >::PointType));
123 o->write((char *)&angle, sizeof(angle));
124 }
125 else
126 {
127 for(unsigned int i = 0; i < 3; ++i)
128 (*o) << m_frame[2][i] << " ";
129 (*o) << angle << " ";
130 }
131 }
132
133 void LowStretchSphereParametrization::Deserialize(std::istream *i, bool binary)
134 {
135 float rot;
136 GfxTL::Frame< 3, float >::PointType normal;
137 if(binary)
138 {
139 i->read((char *)&normal, sizeof(normal));
140 i->read((char *)&rot, sizeof(rot));
141 }
142 else
143 {
144 for(unsigned int j = 0; j < 3; ++j)
145 (*i) >> normal[j];
146 (*i) >> rot;
147 }
148 m_frame.FromNormal(normal);
149 m_frame.RotateOnNormal(rot);
150 }