| 1 |
/****************************************************************************** |
| 2 |
* |
| 3 |
* Project: OpenGIS Simple Features for OpenDRIVE |
| 4 |
* Purpose: Implementation of RoadSignal layer. |
| 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 |
OGRXODRLayerRoadSignal::OGRXODRLayerRoadSignal( |
| 19 |
const RoadElements &xodrRoadElements, const std::string &proj4Defn, |
| 20 |
const bool dissolveTriangulatedSurface) |
| 21 |
: OGRXODRLayer(xodrRoadElements, proj4Defn, dissolveTriangulatedSurface) |
| 22 |
{ |
| 23 |
m_poFeatureDefn = |
| 24 |
std::make_unique<OGRFeatureDefn>(FEATURE_CLASS_NAME.c_str()); |
| 25 |
m_poFeatureDefn->Reference(); |
| 26 |
SetDescription(FEATURE_CLASS_NAME.c_str()); |
| 27 |
|
| 28 |
if (m_bDissolveTIN) |
| 29 |
{ |
| 30 |
OGRwkbGeometryType wkbPointWithZ = OGR_GT_SetZ(wkbPoint); |
| 31 |
m_poFeatureDefn->SetGeomType(wkbPointWithZ); |
| 32 |
} |
| 33 |
else |
| 34 |
{ |
| 35 |
m_poFeatureDefn->SetGeomType(wkbTINZ); |
| 36 |
} |
| 37 |
if (!m_oSRS.IsEmpty()) |
| 38 |
m_poFeatureDefn->GetGeomFieldDefn(0)->SetSpatialRef(&m_oSRS); |
| 39 |
|
| 40 |
OGRFieldDefn oFieldSignalID("SignalID", OFTString); |
| 41 |
m_poFeatureDefn->AddFieldDefn(&oFieldSignalID); |
| 42 |
|
| 43 |
OGRFieldDefn oFieldRoadID("RoadID", OFTString); |
| 44 |
m_poFeatureDefn->AddFieldDefn(&oFieldRoadID); |
| 45 |
|
| 46 |
OGRFieldDefn oFieldType("Type", OFTString); |
| 47 |
m_poFeatureDefn->AddFieldDefn(&oFieldType); |
| 48 |
|
| 49 |
OGRFieldDefn oFieldSubType("SubType", OFTString); |
| 50 |
m_poFeatureDefn->AddFieldDefn(&oFieldSubType); |
| 51 |
|
| 52 |
OGRFieldDefn oFieldHOffset("HOffset", OFTReal); |
| 53 |
m_poFeatureDefn->AddFieldDefn(&oFieldHOffset); |
| 54 |
|
| 55 |
OGRFieldDefn oFieldPitch("Pitch", OFTReal); |
| 56 |
m_poFeatureDefn->AddFieldDefn(&oFieldPitch); |
| 57 |
|
| 58 |
OGRFieldDefn oFieldRoll("Roll", OFTReal); |
| 59 |
m_poFeatureDefn->AddFieldDefn(&oFieldRoll); |
| 60 |
|
| 61 |
OGRFieldDefn oFieldOrientation("Orientation", OFTString); |
| 62 |
m_poFeatureDefn->AddFieldDefn(&oFieldOrientation); |
| 63 |
|
| 64 |
OGRFieldDefn oFieldName("Name", OFTString); |
| 65 |
m_poFeatureDefn->AddFieldDefn(&oFieldName); |
| 66 |
|
| 67 |
OGRFieldDefn oFieldObjectDynamic("Dynamic", OFTInteger); |
| 68 |
oFieldObjectDynamic.SetSubType(OFSTBoolean); |
| 69 |
m_poFeatureDefn->AddFieldDefn(&oFieldObjectDynamic); |
| 70 |
} |
| 71 |
|
| 72 |
int OGRXODRLayerRoadSignal::TestCapability(const char *pszCap) const |
| 73 |
{ |
| 74 |
int result = FALSE; |
| 75 |
|
| 76 |
if (EQUAL(pszCap, OLCZGeometries)) |
| 77 |
result = TRUE; |
| 78 |
|
| 79 |
return result; |
| 80 |
} |
| 81 |
|
| 82 |
OGRFeature *OGRXODRLayerRoadSignal::GetNextRawFeature() |
| 83 |
{ |
| 84 |
std::unique_ptr<OGRFeature> feature; |
| 85 |
|
| 86 |
if (m_roadSignalIter != m_roadElements.roadSignals.end()) |
| 87 |
{ |
| 88 |
feature = std::make_unique<OGRFeature>(m_poFeatureDefn.get()); |
| 89 |
|
| 90 |
odr::RoadSignal roadSignal = *m_roadSignalIter; |
| 91 |
odr::Mesh3D roadSignalMesh = *m_roadSignalMeshesIter; |
| 92 |
|
| 93 |
// Populate geometry field |
| 94 |
if (m_bDissolveTIN) |
| 95 |
{ |
| 96 |
// Use simplified centroid, directly provided by libOpenDRIVE |
| 97 |
std::string roadId = roadSignal.road_id; |
| 98 |
odr::Road road = m_roadElements.roads.at(roadId); |
| 99 |
|
| 100 |
double s = roadSignal.s0; |
| 101 |
double t = roadSignal.t0; |
| 102 |
double h = roadSignal.zOffset; |
| 103 |
odr::Vec3D xyz = road.get_xyz(s, t, h); |
| 104 |
|
| 105 |
auto point = std::make_unique<OGRPoint>(xyz[0], xyz[1], xyz[2]); |
| 106 |
if (!m_oSRS.IsEmpty()) |
| 107 |
point->assignSpatialReference(&m_oSRS); |
| 108 |
feature->SetGeometryDirectly(point.release()); |
| 109 |
} |
| 110 |
else |
| 111 |
{ |
| 112 |
std::unique_ptr<OGRTriangulatedSurface> tin = |
| 113 |
triangulateSurface(roadSignalMesh); |
| 114 |
if (!m_oSRS.IsEmpty()) |
| 115 |
tin->assignSpatialReference(&m_oSRS); |
| 116 |
feature->SetGeometryDirectly(tin.release()); |
| 117 |
} |
| 118 |
|
| 119 |
// Populate other fields |
| 120 |
feature->SetField(m_poFeatureDefn->GetFieldIndex("SignalID"), |
| 121 |
roadSignal.id.c_str()); |
| 122 |
feature->SetField(m_poFeatureDefn->GetFieldIndex("RoadID"), |
| 123 |
roadSignal.road_id.c_str()); |
| 124 |
feature->SetField(m_poFeatureDefn->GetFieldIndex("Type"), |
| 125 |
roadSignal.type.c_str()); |
| 126 |
feature->SetField(m_poFeatureDefn->GetFieldIndex("SubType"), |
| 127 |
roadSignal.subtype.c_str()); |
| 128 |
feature->SetField(m_poFeatureDefn->GetFieldIndex("HOffset"), |
| 129 |
roadSignal.hOffset); |
| 130 |
feature->SetField(m_poFeatureDefn->GetFieldIndex("Pitch"), |
| 131 |
roadSignal.pitch); |
| 132 |
feature->SetField(m_poFeatureDefn->GetFieldIndex("Roll"), |
| 133 |
roadSignal.roll); |
| 134 |
feature->SetField(m_poFeatureDefn->GetFieldIndex("Orientation"), |
| 135 |
roadSignal.orientation.c_str()); |
| 136 |
feature->SetField(m_poFeatureDefn->GetFieldIndex("Name"), |
| 137 |
roadSignal.name.c_str()); |
| 138 |
feature->SetField(m_poFeatureDefn->GetFieldIndex("Dynamic"), |
| 139 |
roadSignal.is_dynamic); |
| 140 |
feature->SetFID(m_nNextFID++); |
| 141 |
|
| 142 |
++m_roadSignalIter; |
| 143 |
++m_roadSignalMeshesIter; |
| 144 |
} |
| 145 |
|
| 146 |
if (feature) |
| 147 |
{ |
| 148 |
return feature.release(); |
| 149 |
} |
| 150 |
else |
| 151 |
{ |
| 152 |
// End of features for the given layer reached. |
| 153 |
return nullptr; |
| 154 |
} |
| 155 |
} |