| 1 |
/****************************************************************************** |
| 2 |
* |
| 3 |
* Project: OpenGIS Simple Features for OpenDRIVE |
| 4 |
* Purpose: Implementation of OGRXODRLayer. |
| 5 |
* Author: Michael Scholz, German Aerospace Center (DLR) |
| 6 |
* Gülsen Bardak, German Aerospace Center (DLR) |
| 7 |
* |
| 8 |
****************************************************************************** |
| 9 |
* Copyright 2024 German Aerospace Center (DLR), Institute of Transportation Systems |
| 10 |
* |
| 11 |
* SPDX-License-Identifier: MIT |
| 12 |
****************************************************************************/ |
| 13 |
|
| 14 |
#include "ogr_api.h" |
| 15 |
#include "ogr_geometry.h" |
| 16 |
#include "ogr_xodr.h" |
| 17 |
|
| 18 |
#include "cpl_error.h" |
| 19 |
#include <cmath> |
| 20 |
#include <iostream> |
| 21 |
#include <memory> |
| 22 |
#include <string> |
| 23 |
#include <typeinfo> |
| 24 |
|
| 25 |
OGRXODRLayer::OGRXODRLayer(const RoadElements &xodrRoadElements, |
| 26 |
const std::string &proj4Defn) |
| 27 |
: OGRXODRLayer(xodrRoadElements, proj4Defn, false) |
| 28 |
{ |
| 29 |
} |
| 30 |
|
| 31 |
OGRXODRLayer::OGRXODRLayer(const RoadElements &xodrRoadElements, |
| 32 |
const std::string &proj4Defn, |
| 33 |
const bool dissolveTriangulatedSurface) |
| 34 |
: m_roadElements(xodrRoadElements), |
| 35 |
m_bDissolveTIN(dissolveTriangulatedSurface) |
| 36 |
{ |
| 37 |
if (!proj4Defn.empty()) |
| 38 |
{ |
| 39 |
m_oSRS.importFromProj4(proj4Defn.c_str()); |
| 40 |
} |
| 41 |
resetRoadElementIterators(); |
| 42 |
} |
| 43 |
|
| 44 |
void OGRXODRLayer::ResetReading() |
| 45 |
{ |
| 46 |
m_nNextFID = 0; |
| 47 |
resetRoadElementIterators(); |
| 48 |
} |
| 49 |
|
| 50 |
void OGRXODRLayer::resetRoadElementIterators() |
| 51 |
{ |
| 52 |
m_roadIter = m_roadElements.roads.begin(); |
| 53 |
m_referenceLineIter = m_roadElements.referenceLines.begin(); |
| 54 |
|
| 55 |
m_laneIter = m_roadElements.lanes.begin(); |
| 56 |
m_laneSectionIter = m_roadElements.laneSections.begin(); |
| 57 |
m_laneRoadIDIter = m_roadElements.laneRoadIDs.begin(); |
| 58 |
m_laneMeshIter = m_roadElements.laneMeshes.begin(); |
| 59 |
|
| 60 |
m_laneLinesInnerIter = m_roadElements.laneLinesInner.begin(); |
| 61 |
m_laneLinesOuterIter = m_roadElements.laneLinesOuter.begin(); |
| 62 |
|
| 63 |
m_roadMarkIter = m_roadElements.roadMarks.begin(); |
| 64 |
m_roadMarkMeshIter = m_roadElements.roadMarkMeshes.begin(); |
| 65 |
|
| 66 |
m_roadObjectIter = m_roadElements.roadObjects.begin(); |
| 67 |
m_roadObjectMeshesIter = m_roadElements.roadObjectMeshes.begin(); |
| 68 |
|
| 69 |
m_roadSignalIter = m_roadElements.roadSignals.begin(); |
| 70 |
m_roadSignalMeshesIter = m_roadElements.roadSignalMeshes.begin(); |
| 71 |
} |
| 72 |
|
| 73 |
std::unique_ptr<OGRTriangulatedSurface> |
| 74 |
OGRXODRLayer::triangulateSurface(const odr::Mesh3D &mesh) |
| 75 |
{ |
| 76 |
std::vector<odr::Vec3D> meshVertices = mesh.vertices; |
| 77 |
std::vector<uint32_t> meshIndices = mesh.indices; |
| 78 |
|
| 79 |
auto tin = std::make_unique<OGRTriangulatedSurface>(); |
| 80 |
const size_t numIndices = meshIndices.size(); |
| 81 |
// Build triangles from mesh vertices. |
| 82 |
// Each triple of mesh indices defines which vertices form a triangle. |
| 83 |
for (std::size_t idx = 0; idx < numIndices; idx += 3) |
| 84 |
{ |
| 85 |
uint32_t vertexIdx = meshIndices[idx]; |
| 86 |
odr::Vec3D vertexP = meshVertices[vertexIdx]; |
| 87 |
OGRPoint p(vertexP[0], vertexP[1], vertexP[2]); |
| 88 |
|
| 89 |
vertexIdx = meshIndices[idx + 1]; |
| 90 |
odr::Vec3D vertexQ = meshVertices[vertexIdx]; |
| 91 |
OGRPoint q(vertexQ[0], vertexQ[1], vertexQ[2]); |
| 92 |
|
| 93 |
vertexIdx = meshIndices[idx + 2]; |
| 94 |
odr::Vec3D vertexR = meshVertices[vertexIdx]; |
| 95 |
OGRPoint r(vertexR[0], vertexR[1], vertexR[2]); |
| 96 |
|
| 97 |
OGRTriangle triangle(p, q, r); |
| 98 |
tin->addGeometry(&triangle); |
| 99 |
} |
| 100 |
|
| 101 |
return tin; |
| 102 |
} |