diff --git a/src/osiparser.cpp b/src/osiparser.cpp index 561a185..256d3f7 100644 --- a/src/osiparser.cpp +++ b/src/osiparser.cpp @@ -482,7 +482,7 @@ OsiParser::ParseSensorData(const osi3::SensorData &sensorData, float color = ldd.detection().Get(j).intensity(); // We measure azimuth clockwise (typical in navigation, but in contrast to the standard spherical coordinates) // x: up, y: out of monitor, z: right - QVector3D posxyz(pos.distance()*cos(pos.azimuth())*cos(pos.elevation()), 0, pos.distance()*sin(pos.azimuth())*cos(pos.elevation())); + QVector3D posxyz(pos.distance()*cos(pos.azimuth())*cos(pos.elevation()), 0, (-1)*pos.distance()*sin(pos.azimuth())*cos(pos.elevation())); // ToDo: transform according to mounting position of sensor PointStruct p = { posxyz, color}; pointMessage.append(p); @@ -745,4 +745,4 @@ ObjectType OsiParser::GetObjectTypeFromOsiObjectType(const osi3::TrafficLight_Classification_Mode& objectType) { return ObjectType::TrafficLight; -} \ No newline at end of file +}