35 #include <unordered_set>
37 static std::pair<float, float> rotateCoords(
float x,
float y,
float origin_x,
float origin_y,
float r )
39 r = qDegreesToRadians( r );
40 float x0 = x - origin_x, y0 = y - origin_y;
44 const float x1 = origin_x + x0 * qCos( r ) - y0 * qSin( r );
45 const float y1 = origin_y + x0 * qSin( r ) + y0 * qCos( r );
46 return std::make_pair( x1, y1 );
49 static void make_quad(
float x0,
float y0,
float z0,
float x1,
float y1,
float z1,
float height, QVector<float> &data,
bool addNormals,
bool addTextureCoords,
float textureRotation )
51 const float dx = x1 - x0;
52 const float dy = -( y1 - y0 );
55 QVector3D vn( -dy, 0, dx );
64 QVector<double> textureCoordinates;
65 textureCoordinates.reserve( 12 );
67 if ( fabsf( dy ) <= fabsf( dx ) )
98 textureCoordinates.push_back( u0 );
99 textureCoordinates.push_back( v0 );
101 textureCoordinates.push_back( u1 );
102 textureCoordinates.push_back( v1 );
104 textureCoordinates.push_back( u2 );
105 textureCoordinates.push_back( v2 );
107 textureCoordinates.push_back( u2 );
108 textureCoordinates.push_back( v2 );
110 textureCoordinates.push_back( u1 );
111 textureCoordinates.push_back( v1 );
113 textureCoordinates.push_back( u3 );
114 textureCoordinates.push_back( v3 );
116 for (
int i = 0; i < textureCoordinates.size(); i += 2 )
118 const std::pair<float, float> rotated = rotateCoords( textureCoordinates[i], textureCoordinates[i + 1], 0, 0, textureRotation );
119 textureCoordinates[i] = rotated.first;
120 textureCoordinates[i + 1] = rotated.second;
125 data << x0 << z0 + height << -y0;
127 data << vn.x() << vn.y() << vn.z();
128 if ( addTextureCoords )
129 data << textureCoordinates[0] << textureCoordinates[1];
131 data << x1 << z1 + height << -y1;
133 data << vn.x() << vn.y() << vn.z();
134 if ( addTextureCoords )
135 data << textureCoordinates[2] << textureCoordinates[3];
137 data << x0 << z0 << -y0;
139 data << vn.x() << vn.y() << vn.z();
140 if ( addTextureCoords )
141 data << textureCoordinates[4] << textureCoordinates[5];
145 data << x0 << z0 << -y0;
147 data << vn.x() << vn.y() << vn.z();
148 if ( addTextureCoords )
149 data << textureCoordinates[6] << textureCoordinates[7];
151 data << x1 << z1 + height << -y1;
153 data << vn.x() << vn.y() << vn.z();
154 if ( addTextureCoords )
155 data << textureCoordinates[8] << textureCoordinates[9];
157 data << x1 << z1 << -y1;
159 data << vn.x() << vn.y() << vn.z();
160 if ( addTextureCoords )
161 data << textureCoordinates[10] << textureCoordinates[11];
166 bool addTextureCoords,
int facade,
float textureRotation )
167 : mOriginX( originX )
168 , mOriginY( originY )
169 , mAddNormals( addNormals )
170 , mInvertNormals( invertNormals )
171 , mAddBackFaces( addBackFaces )
172 , mAddTextureCoords( addTextureCoords )
174 , mTessellatedFacade( facade )
175 , mTextureRotation( textureRotation )
181 bool addTextureCoords,
int facade,
float textureRotation )
183 , mOriginX( mBounds.xMinimum() )
184 , mOriginY( mBounds.yMinimum() )
185 , mAddNormals( addNormals )
186 , mInvertNormals( invertNormals )
187 , mAddBackFaces( addBackFaces )
188 , mAddTextureCoords( addTextureCoords )
190 , mTessellatedFacade( facade )
191 , mTextureRotation( textureRotation )
196 void QgsTessellator::init()
198 mStride = 3 *
sizeof( float );
200 mStride += 3 *
sizeof( float );
201 if ( mAddTextureCoords )
202 mStride += 2 *
sizeof( float );
205 static bool _isRingCounterClockWise(
const QgsCurve &ring )
212 for (
int i = 1; i < count + 1; ++i )
214 ring.
pointAt( i % count, pt, vt );
215 a += ptPrev.
x() * pt.
y() - ptPrev.
y() * pt.
x();
221 static void _makeWalls(
const QgsLineString &ring,
bool ccw,
float extrusionHeight, QVector<float> &data,
222 bool addNormals,
bool addTextureCoords,
double originX,
double originY,
float textureRotation )
227 const bool is_counter_clockwise = _isRingCounterClockWise( ring );
231 for (
int i = 1; i < ring.
numPoints(); ++i )
233 pt = ring.
pointN( is_counter_clockwise == ccw ? i : ring.
numPoints() - i - 1 );
234 float x0 = ptPrev.
x() - originX, y0 = ptPrev.
y() - originY;
235 float x1 = pt.
x() - originX, y1 = pt.
y() - originY;
236 const float z0 = std::isnan( ptPrev.
z() ) ? 0 : ptPrev.
z();
237 const float z1 = std::isnan( pt.
z() ) ? 0 : pt.
z();
240 make_quad( x0, y0, z0, x1, y1, z1, extrusionHeight, data, addNormals, addTextureCoords, textureRotation );
245 static QVector3D _calculateNormal(
const QgsLineString *curve,
double originX,
double originY,
bool invertNormal )
250 return QVector3D( 0, 0, 1 );
258 for (
int i = 1; i < curve->
numPoints(); i++ )
261 if ( pt1.
z() != pt2.
z() )
268 return QVector3D( 0, 0, 1 );
275 double nx = 0, ny = 0, nz = 0;
279 pt1.
setX( pt1.
x() - originX );
280 pt1.
setY( pt1.
y() - originY );
281 for (
int i = 1; i < curve->
numPoints(); i++ )
284 pt2.
setX( pt2.
x() - originX );
285 pt2.
setY( pt2.
y() - originY );
287 if ( std::isnan( pt1.
z() ) || std::isnan( pt2.
z() ) )
290 nx += ( pt1.
y() - pt2.
y() ) * ( pt1.
z() + pt2.
z() );
291 ny += ( pt1.
z() - pt2.
z() ) * ( pt1.
x() + pt2.
x() );
292 nz += ( pt1.
x() - pt2.
x() ) * ( pt1.
y() + pt2.
y() );
297 QVector3D normal( nx, ny, nz );
305 static void _normalVectorToXYVectors(
const QVector3D &pNormal, QVector3D &pXVector, QVector3D &pYVector )
310 if ( pNormal.z() > 0.001 || pNormal.z() < -0.001 )
312 pXVector = QVector3D( 1, 0, -pNormal.x() / pNormal.z() );
314 else if ( pNormal.y() > 0.001 || pNormal.y() < -0.001 )
316 pXVector = QVector3D( 1, -pNormal.x() / pNormal.y(), 0 );
320 pXVector = QVector3D( -pNormal.y() / pNormal.x(), 1, 0 );
322 pXVector.normalize();
323 pYVector = QVector3D::normal( pNormal, pXVector );
328 std::size_t
operator()(
const std::pair<float, float> pair )
const
330 const std::size_t h1 = std::hash<float>()( pair.first );
331 const std::size_t h2 = std::hash<float>()( pair.second );
337 static void _ringToPoly2tri(
const QgsLineString *ring, std::vector<p2t::Point *> &polyline, QHash<p2t::Point *, float> *zHash )
341 polyline.reserve( pCount );
343 const double *srcXData = ring->
xData();
344 const double *srcYData = ring->
yData();
345 const double *srcZData = ring->
zData();
346 std::unordered_set<std::pair<float, float>,
float_pair_hash> foundPoints;
348 for (
int i = 0; i < pCount - 1; ++i )
350 const float x = *srcXData++;
351 const float y = *srcYData++;
353 const auto res = foundPoints.insert( std::make_pair( x, y ) );
360 p2t::Point *pt2 =
new p2t::Point( x, y );
361 polyline.push_back( pt2 );
364 ( *zHash )[pt2] = *srcZData++;
372 const double exp = 1e10;
373 return round( x * exp ) / exp;
377 static QgsCurve *_transform_ring_to_new_base(
const QgsLineString &curve,
const QgsPoint &pt0,
const QMatrix4x4 *toNewBase,
const float scale )
386 double *xData = x.data();
387 double *yData = y.data();
388 double *zData = z.data();
390 const double *srcXData = curve.
xData();
391 const double *srcYData = curve.
yData();
392 const double *srcZData = curve.
is3D() ? curve.
zData() :
nullptr;
394 for (
int i = 0; i < count; ++i )
396 QVector4D v( *srcXData++ - pt0.
x(),
397 *srcYData++ - pt0.
y(),
398 srcZData ? *srcZData++ - pt0.
z() : 0,
401 v = toNewBase->map( v );
404 v.setX( v.x() * scale );
405 v.setY( v.y() * scale );
425 static QgsPolygon *_transform_polygon_to_new_base(
const QgsPolygon &polygon,
const QgsPoint &pt0,
const QMatrix4x4 *toNewBase,
const float scale )
428 p->
setExteriorRing( _transform_ring_to_new_base( *qgsgeometry_cast< const QgsLineString * >( polygon.
exteriorRing() ), pt0, toNewBase, scale ) );
430 p->
addInteriorRing( _transform_ring_to_new_base( *qgsgeometry_cast< const QgsLineString * >( polygon.
interiorRing( i ) ), pt0, toNewBase, scale ) );
439 std::vector< const QgsLineString * > rings;
441 rings.emplace_back( qgsgeometry_cast< const QgsLineString * >( polygon.
exteriorRing() ) );
443 rings.emplace_back( qgsgeometry_cast< const QgsLineString * >( polygon.
interiorRing( i ) ) );
448 if ( numPoints <= 1 )
451 const double *srcXData = ring->
xData();
452 const double *srcYData = ring->
yData();
453 double x0 = *srcXData++;
454 double y0 = *srcYData++;
455 for (
int i = 1; i < numPoints; ++i )
457 const double x1 = *srcXData++;
458 const double y1 = *srcYData++;
459 const double d = ( x0 - x1 ) * ( x0 - x1 ) + ( y0 - y1 ) * ( y0 - y1 );
467 return min_d != 1e20 ? std::sqrt( min_d ) : 1e20;
476 const QVector3D pNormal = !mNoZ ? _calculateNormal( exterior, mOriginX, mOriginY, mInvertNormals ) : QVector3D();
477 const int pCount = exterior->
numPoints();
481 float zMin = std::numeric_limits<float>::max();
482 float zMax = std::numeric_limits<float>::min();
484 const float scale = mBounds.
isNull() ? 1.0 : std::max( 10000.0 / mBounds.
width(), 10000.0 / mBounds.
height() );
486 std::unique_ptr<QMatrix4x4> toNewBase, toOldBase;
488 std::unique_ptr<QgsPolygon> polygonNew;
489 auto rotatePolygonToXYPlane = [&]()
491 if ( !mNoZ && pNormal != QVector3D( 0, 0, 1 ) )
495 QVector3D pXVector, pYVector;
496 _normalVectorToXYVectors( pNormal, pXVector, pYVector );
501 toNewBase.reset(
new QMatrix4x4(
502 pXVector.x(), pXVector.y(), pXVector.z(), 0,
503 pYVector.x(), pYVector.y(), pYVector.z(), 0,
504 pNormal.x(), pNormal.y(), pNormal.z(), 0,
508 toOldBase.reset(
new QMatrix4x4( toNewBase->transposed() ) );
517 polygonNew.reset( _transform_polygon_to_new_base( polygon, pt0, toNewBase.get(), scale ) );
523 const QVector3D upVector( 0, 0, 1 );
524 const float pNormalUpVectorDotProduct = QVector3D::dotProduct( upVector, pNormal );
525 const float radsBetwwenUpNormal = qAcos( pNormalUpVectorDotProduct );
527 const float detectionDelta = qDegreesToRadians( 10.0f );
529 if ( radsBetwwenUpNormal > M_PI_2 - detectionDelta && radsBetwwenUpNormal < M_PI_2 + detectionDelta ) facade = 1;
530 else if ( radsBetwwenUpNormal > - M_PI_2 - detectionDelta && radsBetwwenUpNormal < -M_PI_2 + detectionDelta ) facade = 1;
533 if ( pCount == 4 && polygon.
numInteriorRings() == 0 && ( mTessellatedFacade & facade ) )
536 if ( mAddTextureCoords )
538 rotatePolygonToXYPlane();
539 triangle = qgsgeometry_cast< QgsLineString * >( polygonNew->exteriorRing() );
540 Q_ASSERT( polygonNew->exteriorRing()->numPoints() >= 3 );
544 const double *xData = exterior->
xData();
545 const double *yData = exterior->
yData();
546 const double *zData = !mNoZ ? exterior->
zData() :
nullptr;
547 for (
int i = 0; i < 3; i++ )
549 const float z = !zData ? 0 : *zData;
555 mData << *xData - mOriginX << z << - *yData + mOriginY;
557 mData << pNormal.x() << pNormal.z() << - pNormal.y();
558 if ( mAddTextureCoords )
560 std::pair<float, float> p( triangle->
xAt( i ), triangle->
yAt( i ) );
563 p = rotateCoords( p.first, p.second, 0.0f, 0.0f, mTextureRotation );
565 else if ( facade & 2 )
567 p = rotateCoords( p.first, p.second, 0.0f, 0.0f, mTextureRotation );
569 mData << p.first << p.second;
580 for (
int i = 2; i >= 0; i-- )
582 mData << exterior->
xAt( i ) - mOriginX << ( mNoZ ? 0 : exterior->
zAt( i ) ) << - exterior->
yAt( i ) + mOriginY;
584 mData << -pNormal.x() << -pNormal.z() << pNormal.y();
585 if ( mAddTextureCoords )
587 std::pair<float, float> p( triangle->
xAt( i ), triangle->
yAt( i ) );
590 p = rotateCoords( p.first, p.second, 0.0f, 0.0f, mTextureRotation );
592 else if ( facade & 2 )
594 p = rotateCoords( p.first, p.second, 0.0f, 0.0f, mTextureRotation );
596 mData << p.first << p.second;
601 else if ( mTessellatedFacade & facade )
604 rotatePolygonToXYPlane();
613 if ( polygonSimplified.
isNull() )
618 const QgsPolygon *polygonSimplifiedData = qgsgeometry_cast<const QgsPolygon *>( polygonSimplified.
constGet() );
623 QgsMessageLog::logMessage( QObject::tr(
"geometry's coordinates are too close to each other and simplification failed - skipping" ), QObject::tr(
"3D" ) );
628 polygonNew.reset( polygonSimplifiedData->
clone() );
632 QList< std::vector<p2t::Point *> > polylinesToDelete;
633 QHash<p2t::Point *, float> z;
636 std::vector<p2t::Point *> polyline;
637 _ringToPoly2tri( qgsgeometry_cast< const QgsLineString * >( polygonNew->exteriorRing() ), polyline, mNoZ ?
nullptr : &z );
638 polylinesToDelete << polyline;
640 std::unique_ptr<p2t::CDT> cdt(
new p2t::CDT( polyline ) );
643 for (
int i = 0; i < polygonNew->numInteriorRings(); ++i )
645 std::vector<p2t::Point *> holePolyline;
646 const QgsLineString *hole = qgsgeometry_cast< const QgsLineString *>( polygonNew->interiorRing( i ) );
648 _ringToPoly2tri( hole, holePolyline, mNoZ ?
nullptr : &z );
650 cdt->AddHole( holePolyline );
651 polylinesToDelete << holePolyline;
659 std::vector<p2t::Triangle *> triangles = cdt->GetTriangles();
661 mData.reserve( mData.size() + 3 * triangles.size() * (
stride() /
sizeof(
float ) ) );
662 for (
size_t i = 0; i < triangles.size(); ++i )
664 p2t::Triangle *t = triangles[i];
665 for (
int j = 0; j < 3; ++j )
667 p2t::Point *p = t->GetPoint( j );
668 QVector4D pt( p->x, p->y, mNoZ ? 0 : z[p], 0 );
670 pt = *toOldBase * pt;
671 const double fx = ( pt.x() / scale ) - mOriginX + pt0.
x();
672 const double fy = ( pt.y() / scale ) - mOriginY + pt0.
y();
673 const double fz = mNoZ ? 0 : ( pt.z() + extrusionHeight + pt0.
z() );
679 mData << fx << fz << -fy;
681 mData << pNormal.x() << pNormal.z() << - pNormal.y();
682 if ( mAddTextureCoords )
684 const std::pair<float, float> pr = rotateCoords( p->x, p->y, 0.0f, 0.0f, mTextureRotation );
685 mData << pr.first << pr.second;
692 for (
int j = 2; j >= 0; --j )
694 p2t::Point *p = t->GetPoint( j );
695 QVector4D pt( p->x, p->y, mNoZ ? 0 : z[p], 0 );
697 pt = *toOldBase * pt;
698 const double fx = ( pt.x() / scale ) - mOriginX + pt0.
x();
699 const double fy = ( pt.y() / scale ) - mOriginY + pt0.
y();
700 const double fz = mNoZ ? 0 : ( pt.z() + extrusionHeight + pt0.
z() );
701 mData << fx << fz << -fy;
703 mData << -pNormal.x() << -pNormal.z() << pNormal.y();
704 if ( mAddTextureCoords )
706 const std::pair<float, float> pr = rotateCoords( p->x, p->y, 0.0f, 0.0f, mTextureRotation );
707 mData << pr.first << pr.second;
718 for (
int i = 0; i < polylinesToDelete.count(); ++i )
719 qDeleteAll( polylinesToDelete[i] );
723 if ( extrusionHeight != 0 && ( mTessellatedFacade & 1 ) )
725 _makeWalls( *exterior,
false, extrusionHeight, mData, mAddNormals, mAddTextureCoords, mOriginX, mOriginY, mTextureRotation );
728 _makeWalls( *qgsgeometry_cast< const QgsLineString * >( polygon.
interiorRing( i ) ),
true, extrusionHeight, mData, mAddNormals, mAddTextureCoords, mOriginX, mOriginY, mTextureRotation );
730 zMax += extrusionHeight;
741 return mData.size() / (
stride() /
sizeof( float ) );
746 std::unique_ptr< QgsMultiPolygon > mp = std::make_unique< QgsMultiPolygon >();
747 const auto nVals = mData.size();
748 mp->reserve( nVals / 9 );
749 for (
auto i = decltype( nVals ) {0}; i + 8 < nVals; i += 9 )
752 const QgsPoint p1( mData[i + 0], -mData[i + 2], mData[i + 1] );
753 const QgsPoint p2( mData[i + 3], -mData[i + 5], mData[i + 4] );
754 const QgsPoint p3( mData[i + 6], -mData[i + 8], mData[i + 7] );
VertexType
Types of vertex.
bool is3D() const SIP_HOLDGIL
Returns true if the geometry is 3D and contains a z-value.
QgsWkbTypes::Type wkbType() const SIP_HOLDGIL
Returns the WKB type of the geometry.
const QgsCurve * interiorRing(int i) const SIP_HOLDGIL
Retrieves an interior ring from the curve polygon.
const QgsCurve * exteriorRing() const SIP_HOLDGIL
Returns the curve polygon's exterior ring.
int numInteriorRings() const SIP_HOLDGIL
Returns the number of interior rings contained with the curve polygon.
Abstract base class for curved geometry type.
virtual int numPoints() const =0
Returns the number of points in the curve.
virtual bool pointAt(int node, QgsPoint &point, Qgis::VertexType &type) const =0
Returns the point and vertex id of a point within the curve.
A geometry is the spatial representation of a feature.
const QgsAbstractGeometry * constGet() const SIP_HOLDGIL
Returns a non-modifiable (const) reference to the underlying abstract geometry primitive.
QgsGeometry simplify(double tolerance) const
Returns a simplified version of this geometry using a specified tolerance value.
Line string geometry type, with support for z-dimension and m-values.
QgsPoint startPoint() const override SIP_HOLDGIL
Returns the starting point of the curve.
const double * yData() const
Returns a const pointer to the y vertex data.
int numPoints() const override SIP_HOLDGIL
Returns the number of points in the curve.
QgsPoint pointN(int i) const
Returns the specified point from inside the line string.
bool isEmpty() const override SIP_HOLDGIL
Returns true if the geometry is empty.
double yAt(int index) const override
Returns the y-coordinate of the specified node in the line string.
double zAt(int index) const
Returns the z-coordinate of the specified node in the line string.
const double * xData() const
Returns a const pointer to the x vertex data.
const double * zData() const
Returns a const pointer to the z vertex data, or nullptr if the linestring does not have z values.
double xAt(int index) const override
Returns the x-coordinate of the specified node in the line string.
static void logMessage(const QString &message, const QString &tag=QString(), Qgis::MessageLevel level=Qgis::MessageLevel::Warning, bool notifyUser=true)
Adds a message to the log instance (and creates it if necessary).
Point geometry type, with support for z-dimension and m-values.
void setX(double x) SIP_HOLDGIL
Sets the point's x-coordinate.
void setY(double y) SIP_HOLDGIL
Sets the point's y-coordinate.
void setExteriorRing(QgsCurve *ring) override
Sets the exterior ring of the polygon.
void addInteriorRing(QgsCurve *ring) override
Adds an interior ring to the geometry (takes ownership)
QgsPolygon * clone() const override
Clones the geometry by performing a deep copy.
A rectangle specified with double values.
bool isNull() const
Test if the rectangle is null (all coordinates zero or after call to setMinimal()).
double height() const SIP_HOLDGIL
Returns the height of the rectangle.
double width() const SIP_HOLDGIL
Returns the width of the rectangle.
std::unique_ptr< QgsMultiPolygon > asMultiPolygon() const
Returns the triangulation as a multipolygon geometry.
QgsTessellator(double originX, double originY, bool addNormals, bool invertNormals=false, bool addBackFaces=false, bool noZ=false, bool addTextureCoords=false, int facade=3, float textureRotation=0.0f)
Creates tessellator with a specified origin point of the world (in map coordinates)
int stride() const
Returns size of one vertex entry in bytes.
void addPolygon(const QgsPolygon &polygon, float extrusionHeight)
Tessellates a triangle and adds its vertex entries to the output data array.
int dataVerticesCount() const
Returns the number of vertices stored in the output data array.
static bool hasZ(Type type) SIP_HOLDGIL
Tests whether a WKB type contains the z-dimension.
bool qgsDoubleNear(double a, double b, double epsilon=4 *std::numeric_limits< double >::epsilon())
Compare two doubles (but allow some difference)
double _round_coord(double x)
double _minimum_distance_between_coordinates(const QgsPolygon &polygon)
std::size_t operator()(const std::pair< float, float > pair) const