Debian Codegraph @

ogr/ogrsf_frmts/xodr/ogrxodrlayer.cpp

raw
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 }