From b04749245e32e25607f474faf7e0fd5c6528e21c Mon Sep 17 00:00:00 2001
From: Mohcine Chraibi <m.chraibi@fz-juelich.de>
Date: Tue, 20 Nov 2018 15:32:39 +0100
Subject: [PATCH] WIP: bug in parsing sources
---
src/SaxParser.cpp | 2643 +++++++++++++++++++++++----------------------
1 file changed, 1322 insertions(+), 1321 deletions(-)
diff --git a/src/SaxParser.cpp b/src/SaxParser.cpp
index 6148950..2c8ddd1 100644
--- a/src/SaxParser.cpp
+++ b/src/SaxParser.cpp
@@ -6,9 +6,9 @@
* Copyright (C) <2009-2010>
*
* @section LICENSE
- * This file is part of OpenPedSim.
+ * This file is part of JuPedSim.
*
- * OpenPedSim is free software: you can redistribute it and/or modify
+ * JuPedSim is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* any later version.
@@ -19,7 +19,7 @@
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
- * along with OpenPedSim. If not, see <http://www.gnu.org/licenses/>.
+ * along with JuPedSim. If not, see <http://www.gnu.org/licenses/>.
*
* @section DESCRIPTION
*
@@ -73,8 +73,8 @@
#include <vtkStripper.h>
-#define VTK_CREATE(type, name) \
- vtkSmartPointer<type> name = vtkSmartPointer<type>::New()
+#define VTK_CREATE(type, name) \
+ vtkSmartPointer<type> name = vtkSmartPointer<type>::New()
using namespace std;
@@ -90,17 +90,17 @@ using namespace std;
*/
SaxParser::SaxParser(GeometryFactory& geoFac, SyncData& dataset, double * fps):_geoFactory(geoFac),_dataset(dataset)
{
- _para=fps;
- _parsingWalls=false;
- _parsingCrossings=false;
- _color=0.0;
- _dataset.clearFrames();
+ _para=fps;
+ _parsingWalls=false;
+ _parsingCrossings=false;
+ _color=0.0;
+ _dataset.clearFrames();
- _geometry = std::shared_ptr<FacilityGeometry>(new FacilityGeometry("No name", "No name", "No name"));
- _geoFactory.AddElement(-1,-1,_geometry);
+ _geometry = std::shared_ptr<FacilityGeometry>(new FacilityGeometry("No name", "No name", "No name"));
+ _geoFactory.AddElement(-1,-1,_geometry);
- //default header
- InitHeader(0,0,0);
+ //default header
+ InitHeader(0,0,0);
}
SaxParser::~SaxParser()
@@ -112,563 +112,564 @@ bool SaxParser::startElement(const QString & /* namespaceURI */,
const QString & /* localName */, const QString &qName,
const QXmlAttributes &at)
{
- if (qName == "header") {
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="version") {
- QStringList query = at.value(i).split(".");
- int major=0;
- int minor=0;
- int patch=0;
- switch (query.size() ) {
- case 1:
- major=query.at(0).toInt();
- break;
- case 2:
- major=query.at(0).toInt();
- minor=query.at(1).toInt();
- break;
- case 3:
- major=query.at(0).toInt();
- minor=query.at(1).toInt();
- patch=query.at(2).toInt();
- break;
- }
- InitHeader(major,minor,patch);
- //cout<<"version found:"<<at.value(i).toStdString()<<endl;exit(0);
- }
- }
- } else if (qName == "file") {
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="location") {
- QString fileName=at.value(i);
- if(!fileName.isEmpty()) {
- if(fileName.endsWith(".xml",Qt::CaseInsensitive)) {
- //SaxParser::parseGeometryJPS(fileName,geometry);
- } else if (fileName.endsWith(".trav",Qt::CaseInsensitive)) {
- SaxParser::parseGeometryTRAV(fileName,_geoFactory);
+ if (qName == "header") {
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="version") {
+ QStringList query = at.value(i).split(".");
+ int major=0;
+ int minor=0;
+ int patch=0;
+ switch (query.size() ) {
+ case 1:
+ major=query.at(0).toInt();
+ break;
+ case 2:
+ major=query.at(0).toInt();
+ minor=query.at(1).toInt();
+ break;
+ case 3:
+ major=query.at(0).toInt();
+ minor=query.at(1).toInt();
+ patch=query.at(2).toInt();
+ break;
}
- }
- }
- }
- else if (qName == "source")
- {
- double xmin, xmax, ymin, ymax;
- double z=0;// @todo read this some when we go 3D
-
- int source_id=-1;
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="id") {
- source_id=at.value(i).toInt();
- } else if(at.localName(i)=="x_min") {
- xmin=at.value(i).toDouble()*FAKTOR;
- }
- else if(at.localName(i)=="x_max") {
- xmax=at.value(i).toDouble()*FAKTOR;
- }
- else if(at.localName(i)=="y_min") {
- ymin=at.value(i).toDouble()*FAKTOR;
- }
- else if(at.localName(i)=="y_max") {
- ymax=at.value(i).toDouble()*FAKTOR;
- }
- }
- _geometry->addSource(xmin,ymin,xmax,ymax);
-
- // double CHT[3]= {_color,_height,_thickness};
- // JPoint* pt1= new JPoint(xmin,ymin,z);
- // JPoint* pt2= new JPoint(xmin,ymax,z);
- // JPoint* pt3= new JPoint(xmax,ymin,z);
- // JPoint* pt4= new JPoint(xmax,ymax,z);
- // pt1->setColorHeightThicknes(CHT);
- // pt2->setColorHeightThicknes(CHT);
- // pt3->setColorHeightThicknes(CHT);
- // pt4->setColorHeightThicknes(CHT);
- // _currentPointsList.push_back(pt1);
- // _currentPointsList.push_back(pt2);
- // _currentPointsList.push_back(pt3);
- // _currentPointsList.push_back(pt4);
- } // source
- } else if (qName == "floor") {
- double xMin=0,
- xMax=0,
- yMin=0,
- yMax=0;
-
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="xMin") {
- xMin=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="xMax") {
- xMax=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="yMin") {
- yMin=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="yMax") {
- yMax=at.value(i).toDouble()*FAKTOR;
- }
-
- }
- _geometry->addFloor(xMin,yMin,xMax,yMax);
- } else if (qName == "cuboid") {
- double length=0, height=0,
- width=0, color=0;
- double center[3]= {0,0,0};
-
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="centerX") {
- center[0]=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="centerY") {
- center[1]=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="centerZ") {
- center[2]=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="length") {
- length=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="height") {
- height=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="width") {
- width=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="color") {
- color=at.value(i).toDouble()*FAKTOR;
- }
- }
- _geometry->addObjectBox(center,height,width,length,color);
-
- } else if (qName == "sphere") {
- double radius=0, color=0;
- double center[3]= {0,0,0};
-
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="centerX") {
- center[0]=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="centerY") {
- center[1]=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="centerZ") {
- center[2]=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="radius") {
- radius=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="color") {
- color=at.value(i).toDouble();
- }
- }
- _geometry->addObjectSphere(center,radius,color);
- } else if (qName == "label") {
- double color=0;
- double center[3]= {0,0,0};
- QString text;
-
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="centerX") {
- center[0]=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="centerY") {
- center[1]=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="centerZ") {
- center[2]=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="text") {
- text=at.value(i);
- } else if(at.localName(i)=="color") {
- color=at.value(i).toDouble();
- }
- }
- _geometry->addObjectLabel(center,center,text.toStdString(),color);
- } else if (qName == "cylinder") {
- double height=0, radius=0, color=0;
- double center[3]= {0,0,0};
- double rotation[3]= {0,0,0};
-
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="centerX") {
- center[0]=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="centerY") {
- center[1]=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="centerZ") {
- center[2]=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="height") {
- height=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="radius") {
- radius=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="color") {
- color=at.value(i).toDouble();
- } else if(at.localName(i)=="angleX") {
- rotation[0]=at.value(i).toDouble();
- } else if(at.localName(i)=="angleY") {
- rotation[1]=at.value(i).toDouble();
- } else if(at.localName(i)=="angleZ") {
- rotation[2]=at.value(i).toDouble();
- }
- }
- _geometry->addObjectCylinder(center,radius,height,rotation,color);
- } else if (qName == "agents") {
- } else if (qName == "roomCaption") {
- } else if (qName == "frameRate") {
- } else if (qName == "geometry")
- {
- //cout<<"geo tag found"<<endl;
- //_geometry = std::shared_ptr<FacilityGeometry>(new FacilityGeometry("No name"));
- //_geoFactory.AddElement(0,0,_geometry);
-
- }else if (qName == "gradient_field"){
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="filename") {
- ParseGradientFieldVTK(at.value(i),_geoFactory);
- }
- }
-
- }
- else if (qName == "wall") {
- _parsingWalls=true;
- _thickness=15;
- _height=250;
- _color=0;
- _caption="";
-
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="thickness") {
- _thickness=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="height") {
- _height=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="color") {
- _color=at.value(i).toDouble();
- } else if(at.localName(i)=="caption") {
- _caption=at.value(i);
- }
- }
-
- } else if (qName == "door") {
- _parsingWalls=false;
- _thickness=15;
- _height=250;
- _color=255;
- _caption="";
-
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="thickness") {
- _thickness=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="height") {
- _height=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="color") {
- _color=at.value(i).toDouble();
- } else if(at.localName(i)=="caption") {
- _caption=at.value(i);
- }
- }
-
- }
- //FIXME
- else if (qName == "crossing") {
- _parsingWalls=false;
- _parsingCrossings=true;
- _thickness=15;
- _height=250;
- _color=255;
- _caption="";
-
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="thickness") {
- _thickness=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="height") {
- _height=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="color") {
- _color=at.value(i).toDouble();
- } else if(at.localName(i)=="caption") {
- _caption=at.value(i);
- }
- }
-
- }else if (qName == "hline") {
- _parsingWalls=false;
- _parsingCrossings=true;
- _thickness=15;
- _height=250;
- _color=255;
- _caption="";
- QString room_id, subroom_id;
-
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="thickness") {
- _thickness=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="height") {
- _height=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="color") {
- _color=at.value(i).toDouble();
- } else if(at.localName(i)=="caption") {
- _caption=at.value(i);
- }else if(at.localName(i)=="room_id") {
- room_id=at.value(i);
- }else if(at.localName(i)=="subroom_id") {
- subroom_id=at.value(i);
- }
- }
- _caption=room_id+":"+subroom_id+":"+_caption;
-
- }
- else if (qName == "timeFirstFrame") {
- /*unsigned long timeFirstFrame_us=0;
- unsigned long timeFirstFrame_s=0;
-
- for(int i=0; i<at.length(); i++) {
+ InitHeader(major,minor,patch);
+ //cout<<"version found:"<<at.value(i).toStdString()<<endl;exit(0);
+ }
+ }
+ } else if (qName == "file") {
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="location") {
+ QString fileName=at.value(i);
+ if(!fileName.isEmpty()) {
+ if(fileName.endsWith(".xml",Qt::CaseInsensitive)) {
+ //SaxParser::parseGeometryJPS(fileName,geometry);
+ } else if (fileName.endsWith(".trav",Qt::CaseInsensitive)) {
+ SaxParser::parseGeometryTRAV(fileName,_geoFactory);
+ }
+ }
+ }
+ }
+ }
+ else if (qName == "source")
+ {
+ double xmin, xmax, ymin, ymax;
+ double z=0;// @todo read this some when we go 3D
+
+ int source_id=-1;
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="id") {
+ source_id=at.value(i).toInt();
+ } else if(at.localName(i)=="x_min") {
+ xmin=at.value(i).toDouble()*FAKTOR;
+ }
+ else if(at.localName(i)=="x_max") {
+ xmax=at.value(i).toDouble()*FAKTOR;
+ }
+ else if(at.localName(i)=="y_min") {
+ ymin=at.value(i).toDouble()*FAKTOR;
+ }
+ else if(at.localName(i)=="y_max") {
+ ymax=at.value(i).toDouble()*FAKTOR;
+ }
+ }
+ _geometry->addSource(xmin,ymin,xmax,ymax);
+
+ // double CHT[3]= {_color,_height,_thickness};
+ // JPoint* pt1= new JPoint(xmin,ymin,z);
+ // JPoint* pt2= new JPoint(xmin,ymax,z);
+ // JPoint* pt3= new JPoint(xmax,ymin,z);
+ // JPoint* pt4= new JPoint(xmax,ymax,z);
+ // pt1->setColorHeightThicknes(CHT);
+ // pt2->setColorHeightThicknes(CHT);
+ // pt3->setColorHeightThicknes(CHT);
+ // pt4->setColorHeightThicknes(CHT);
+ // _currentPointsList.push_back(pt1);
+ // _currentPointsList.push_back(pt2);
+ // _currentPointsList.push_back(pt3);
+ // _currentPointsList.push_back(pt4);
+ } // source
+ else if (qName == "floor") {
+ double xMin=0,
+ xMax=0,
+ yMin=0,
+ yMax=0;
+
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="xMin") {
+ xMin=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="xMax") {
+ xMax=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="yMin") {
+ yMin=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="yMax") {
+ yMax=at.value(i).toDouble()*FAKTOR;
+ }
+
+ }
+ _geometry->addFloor(xMin,yMin,xMax,yMax);
+ } else if (qName == "cuboid") {
+ double length=0, height=0,
+ width=0, color=0;
+ double center[3]= {0,0,0};
+
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="centerX") {
+ center[0]=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="centerY") {
+ center[1]=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="centerZ") {
+ center[2]=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="length") {
+ length=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="height") {
+ height=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="width") {
+ width=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="color") {
+ color=at.value(i).toDouble()*FAKTOR;
+ }
+ }
+ _geometry->addObjectBox(center,height,width,length,color);
+
+ } else if (qName == "sphere") {
+ double radius=0, color=0;
+ double center[3]= {0,0,0};
+
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="centerX") {
+ center[0]=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="centerY") {
+ center[1]=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="centerZ") {
+ center[2]=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="radius") {
+ radius=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="color") {
+ color=at.value(i).toDouble();
+ }
+ }
+ _geometry->addObjectSphere(center,radius,color);
+ } else if (qName == "label") {
+ double color=0;
+ double center[3]= {0,0,0};
+ QString text;
+
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="centerX") {
+ center[0]=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="centerY") {
+ center[1]=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="centerZ") {
+ center[2]=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="text") {
+ text=at.value(i);
+ } else if(at.localName(i)=="color") {
+ color=at.value(i).toDouble();
+ }
+ }
+ _geometry->addObjectLabel(center,center,text.toStdString(),color);
+ } else if (qName == "cylinder") {
+ double height=0, radius=0, color=0;
+ double center[3]= {0,0,0};
+ double rotation[3]= {0,0,0};
+
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="centerX") {
+ center[0]=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="centerY") {
+ center[1]=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="centerZ") {
+ center[2]=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="height") {
+ height=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="radius") {
+ radius=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="color") {
+ color=at.value(i).toDouble();
+ } else if(at.localName(i)=="angleX") {
+ rotation[0]=at.value(i).toDouble();
+ } else if(at.localName(i)=="angleY") {
+ rotation[1]=at.value(i).toDouble();
+ } else if(at.localName(i)=="angleZ") {
+ rotation[2]=at.value(i).toDouble();
+ }
+ }
+ _geometry->addObjectCylinder(center,radius,height,rotation,color);
+ } else if (qName == "agents") {
+ } else if (qName == "roomCaption") {
+ } else if (qName == "frameRate") {
+ } else if (qName == "geometry")
+ {
+ //cout<<"geo tag found"<<endl;
+ //_geometry = std::shared_ptr<FacilityGeometry>(new FacilityGeometry("No name"));
+ //_geoFactory.AddElement(0,0,_geometry);
+
+ }else if (qName == "gradient_field"){
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="filename") {
+ ParseGradientFieldVTK(at.value(i),_geoFactory);
+ }
+ }
+
+ }
+ else if (qName == "wall") {
+ _parsingWalls=true;
+ _thickness=15;
+ _height=250;
+ _color=0;
+ _caption="";
+
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="thickness") {
+ _thickness=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="height") {
+ _height=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="color") {
+ _color=at.value(i).toDouble();
+ } else if(at.localName(i)=="caption") {
+ _caption=at.value(i);
+ }
+ }
+
+ } else if (qName == "door") {
+ _parsingWalls=false;
+ _thickness=15;
+ _height=250;
+ _color=255;
+ _caption="";
+
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="thickness") {
+ _thickness=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="height") {
+ _height=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="color") {
+ _color=at.value(i).toDouble();
+ } else if(at.localName(i)=="caption") {
+ _caption=at.value(i);
+ }
+ }
+
+ }
+//FIXME
+ else if (qName == "crossing") {
+ _parsingWalls=false;
+ _parsingCrossings=true;
+ _thickness=15;
+ _height=250;
+ _color=255;
+ _caption="";
+
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="thickness") {
+ _thickness=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="height") {
+ _height=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="color") {
+ _color=at.value(i).toDouble();
+ } else if(at.localName(i)=="caption") {
+ _caption=at.value(i);
+ }
+ }
+
+ }else if (qName == "hline") {
+ _parsingWalls=false;
+ _parsingCrossings=true;
+ _thickness=15;
+ _height=250;
+ _color=255;
+ _caption="";
+ QString room_id, subroom_id;
+
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="thickness") {
+ _thickness=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="height") {
+ _height=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="color") {
+ _color=at.value(i).toDouble();
+ } else if(at.localName(i)=="caption") {
+ _caption=at.value(i);
+ }else if(at.localName(i)=="room_id") {
+ room_id=at.value(i);
+ }else if(at.localName(i)=="subroom_id") {
+ subroom_id=at.value(i);
+ }
+ }
+ _caption=room_id+":"+subroom_id+":"+_caption;
+
+ }
+ else if (qName == "timeFirstFrame") {
+ /*unsigned long timeFirstFrame_us=0;
+ unsigned long timeFirstFrame_s=0;
+
+ for(int i=0; i<at.length(); i++) {
if(at.localName(i)=="microsec") {
- timeFirstFrame_us=at.value(i).toULong();
+ timeFirstFrame_us=at.value(i).toULong();
} else if(at.localName(i)=="sec") {
- timeFirstFrame_s=at.value(i).toULong();
- }
- }
- dataset->setDelayAbsolute(timeFirstFrame_s,timeFirstFrame_us);
- */
- } else if (qName == "point") {
- double xPos=0;
- double yPos=0;
- double zPos=0;
-
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="xPos") {
- xPos=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="yPos") {
- yPos=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)=="zPos") {
- zPos=at.value(i).toDouble()*FAKTOR;
- }
- }
- double CHT[3]= {_color,_height,_thickness};
- JPoint* pt= new JPoint(xPos,yPos,zPos);
- pt->setColorHeightThicknes(CHT);
- _currentPointsList.push_back(pt);
-
- }
- else if (qName == "frame")
- {
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="ID") {
- _currentFrameID=at.value(i).toInt();
- //cout<<"frame: " <<_currentFrameID<<endl;
+ timeFirstFrame_s=at.value(i).toULong();
}
- }
-
- }
- else if (qName == "agent") {
-
- int id=0;
- double xPos=0;
- double yPos=0;
- double zPos=0;
- //double agent_color =std::numeric_limits<double>::quiet_NaN();
- //double xVel=std::numeric_limits<double>::quiet_NaN();
- //double yVel=std::numeric_limits<double>::quiet_NaN();
- //double zVel=std::numeric_limits<double>::quiet_NaN();
- double dia_a=std::numeric_limits<double>::quiet_NaN();
- double dia_b=std::numeric_limits<double>::quiet_NaN();
- double el_angle=std::numeric_limits<double>::quiet_NaN();
- double el_color=std::numeric_limits<double>::quiet_NaN();
- double el_x=std::numeric_limits<double>::quiet_NaN();
- double el_y=std::numeric_limits<double>::quiet_NaN();
- double el_z=std::numeric_limits<double>::quiet_NaN();
-
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="ID") {
- id=at.value(i).toInt();
- //TODO: maybe you should change ur format to take the ID 0 as first valid ID.
- if (id==0) {
- //slotErrorOutput("Person with ID=0 detected. ID should start with 1 !");
- return false;
- }
- } else if(at.localName(i)==_jps_xPos) {
- xPos=at.value(i).toDouble()*FAKTOR;
- //xPos=at.value(i).toDouble();
- } else if(at.localName(i)==_jps_yPos) {
- //yPos=at.value(i).toDouble();
- yPos=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)==_jps_zPos) {
- zPos=at.value(i).toDouble()*FAKTOR;
}
-
- else if(at.localName(i)==_jps_radiusA) {
- dia_a=at.value(i).toDouble()*FAKTOR;
- //dia_a=at.value(i).toDouble();
- } else if(at.localName(i)==_jps_radiusB) {
- dia_b=at.value(i).toDouble()*FAKTOR;
- //dia_b=at.value(i).toDouble();
- } else if(at.localName(i)==_jps_ellipseOrientation) {
- el_angle=at.value(i).toDouble();
- } else if(at.localName(i)==_jps_ellipseColor) {
- el_color=at.value(i).toDouble();
- } else if(at.localName(i)=="agentColor") {
- //agent_color=at.value(i).toDouble();
- } else if(at.localName(i)==_jps_xVel) {
- //xVel=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)==_jps_yVel) {
- //yVel=at.value(i).toDouble()*FAKTOR;
- } else if(at.localName(i)==_jps_zVel) {
- //zVel=at.value(i).toDouble()*FAKTOR;
- }
-
- }
+ dataset->setDelayAbsolute(timeFirstFrame_s,timeFirstFrame_us);
+ */
+ } else if (qName == "point") {
+ double xPos=0;
+ double yPos=0;
+ double zPos=0;
+
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="xPos") {
+ xPos=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="yPos") {
+ yPos=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)=="zPos") {
+ zPos=at.value(i).toDouble()*FAKTOR;
+ }
+ }
+ double CHT[3]= {_color,_height,_thickness};
+ JPoint* pt= new JPoint(xPos,yPos,zPos);
+ pt->setColorHeightThicknes(CHT);
+ _currentPointsList.push_back(pt);
+
+ }
+ else if (qName == "frame")
+ {
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="ID") {
+ _currentFrameID=at.value(i).toInt();
+ //cout<<"frame: " <<_currentFrameID<<endl;
+ }
+ }
+
+ }
+ else if (qName == "agent") {
+
+ int id=0;
+ double xPos=0;
+ double yPos=0;
+ double zPos=0;
+ //double agent_color =std::numeric_limits<double>::quiet_NaN();
+ //double xVel=std::numeric_limits<double>::quiet_NaN();
+ //double yVel=std::numeric_limits<double>::quiet_NaN();
+ //double zVel=std::numeric_limits<double>::quiet_NaN();
+ double dia_a=std::numeric_limits<double>::quiet_NaN();
+ double dia_b=std::numeric_limits<double>::quiet_NaN();
+ double el_angle=std::numeric_limits<double>::quiet_NaN();
+ double el_color=std::numeric_limits<double>::quiet_NaN();
+ double el_x=std::numeric_limits<double>::quiet_NaN();
+ double el_y=std::numeric_limits<double>::quiet_NaN();
+ double el_z=std::numeric_limits<double>::quiet_NaN();
+
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="ID") {
+ id=at.value(i).toInt();
+ //TODO: maybe you should change ur format to take the ID 0 as first valid ID.
+ if (id==0) {
+ //slotErrorOutput("Person with ID=0 detected. ID should start with 1 !");
+ return false;
+ }
+ } else if(at.localName(i)==_jps_xPos) {
+ xPos=at.value(i).toDouble()*FAKTOR;
+ //xPos=at.value(i).toDouble();
+ } else if(at.localName(i)==_jps_yPos) {
+ //yPos=at.value(i).toDouble();
+ yPos=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)==_jps_zPos) {
+ zPos=at.value(i).toDouble()*FAKTOR;
+ }
+
+ else if(at.localName(i)==_jps_radiusA) {
+ dia_a=at.value(i).toDouble()*FAKTOR;
+ //dia_a=at.value(i).toDouble();
+ } else if(at.localName(i)==_jps_radiusB) {
+ dia_b=at.value(i).toDouble()*FAKTOR;
+ //dia_b=at.value(i).toDouble();
+ } else if(at.localName(i)==_jps_ellipseOrientation) {
+ el_angle=at.value(i).toDouble();
+ } else if(at.localName(i)==_jps_ellipseColor) {
+ el_color=at.value(i).toDouble();
+ } else if(at.localName(i)=="agentColor") {
+ //agent_color=at.value(i).toDouble();
+ } else if(at.localName(i)==_jps_xVel) {
+ //xVel=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)==_jps_yVel) {
+ //yVel=at.value(i).toDouble()*FAKTOR;
+ } else if(at.localName(i)==_jps_zVel) {
+ //zVel=at.value(i).toDouble()*FAKTOR;
+ }
+
+ }
// xml2txt
// cout << _currentFrameID << " " << id << " " << xPos << " " << yPos << " " << zPos << "\n";
- //coordinates of the ellipse, default to the head of the agent
- //if(std::isnan(el_x)) el_x=xPos;
- //if(std::isnan(el_y)) el_y=yPos;
- //if(std::isnan(el_z)) el_z=zPos;
-
- //double pos[3]={xPos,yPos,zPos};
- //double vel[3]={xVel,yPos,zPos};
- //double ellipse[7]={el_x,el_y,el_z,dia_a,dia_b,el_angle,el_color};
- //double para[2]={agent_color,el_angle};
-
- double pos[3]= {xPos,yPos,zPos};
- double angle[3]= {0,0,el_angle};
- double radius[3]= {dia_a,dia_b,30.0};
-
- FrameElement *element = new FrameElement(id-1);
- element->SetPos(pos);
- element->SetOrientation(angle);
- element->SetRadius(radius);
- element->SetColor(el_color);
- _currentFrame.push_back(element);
-
- } else if (qName == "agentInfo") {
- double height=std::numeric_limits<double>::quiet_NaN();
- double color=std::numeric_limits<double>::quiet_NaN();
- double id=std::numeric_limits<double>::quiet_NaN();
-
- for(int i=0; i<at.length(); i++) {
- if(at.localName(i)=="ID") {
- id=at.value(i).toDouble();
- }
- if(at.localName(i)=="height") {
- height=at.value(i).toDouble()*FAKTOR;
- }
- if(at.localName(i)=="color") {
- color=at.value(i).toDouble();
- }
- }
- if(std::isnan(id)) return true;
-
- if(!std::isnan(height)) {
- _initialPedestriansHeights.append(QString::number(int(id)));
- _initialPedestriansHeights.append(QString::number(height));
- }
- if(!std::isnan(color)) {
- _initialPedestriansColors.append(QString::number(int(id)));
- _initialPedestriansColors.append(QString::number(int(color)));
- }
- }
- return true;
+ //coordinates of the ellipse, default to the head of the agent
+ //if(std::isnan(el_x)) el_x=xPos;
+ //if(std::isnan(el_y)) el_y=yPos;
+ //if(std::isnan(el_z)) el_z=zPos;
+
+ //double pos[3]={xPos,yPos,zPos};
+ //double vel[3]={xVel,yPos,zPos};
+ //double ellipse[7]={el_x,el_y,el_z,dia_a,dia_b,el_angle,el_color};
+ //double para[2]={agent_color,el_angle};
+
+ double pos[3]= {xPos,yPos,zPos};
+ double angle[3]= {0,0,el_angle};
+ double radius[3]= {dia_a,dia_b,30.0};
+
+ FrameElement *element = new FrameElement(id-1);
+ element->SetPos(pos);
+ element->SetOrientation(angle);
+ element->SetRadius(radius);
+ element->SetColor(el_color);
+ _currentFrame.push_back(element);
+
+ } else if (qName == "agentInfo") {
+ double height=std::numeric_limits<double>::quiet_NaN();
+ double color=std::numeric_limits<double>::quiet_NaN();
+ double id=std::numeric_limits<double>::quiet_NaN();
+
+ for(int i=0; i<at.length(); i++) {
+ if(at.localName(i)=="ID") {
+ id=at.value(i).toDouble();
+ }
+ if(at.localName(i)=="height") {
+ height=at.value(i).toDouble()*FAKTOR;
+ }
+ if(at.localName(i)=="color") {
+ color=at.value(i).toDouble();
+ }
+ }
+ if(std::isnan(id)) return true;
+
+ if(!std::isnan(height)) {
+ _initialPedestriansHeights.append(QString::number(int(id)));
+ _initialPedestriansHeights.append(QString::number(height));
+ }
+ if(!std::isnan(color)) {
+ _initialPedestriansColors.append(QString::number(int(id)));
+ _initialPedestriansColors.append(QString::number(int(color)));
+ }
+ }
+ return true;
}
bool SaxParser::characters(const QString &str)
{
- _currentText.append(str);
- return true;
+ _currentText.append(str);
+ return true;
}
bool SaxParser::endElement(const QString & /* namespaceURI */,
const QString & /* localName */, const QString &qName)
{
- if (qName == "header") {
-
- } else if (qName == "agents") {
- _dataset.setNumberOfAgents(_currentText.toInt());
- } else if (qName == "frameRate") {
- _para[0]=_currentText.toFloat();
- } else if (qName == "wall") {
- if(_currentPointsList.size()>1)
- for(unsigned int i=0; i<_currentPointsList.size()-1; i++) {
- _geometry->addWall(_currentPointsList[i],_currentPointsList[i+1],_caption.toStdString());
- }
- clearPoints();
- } else if (qName == "door") {
- for(unsigned int i=0; i<_currentPointsList.size()-1; i++) {
- _geometry->addDoor(_currentPointsList[i],_currentPointsList[i+1],_caption.toStdString());
- }
- clearPoints();
- } else if (qName == "crossing") {
- if(_currentPointsList.size()>1) //hack
- for(unsigned int i=0; i<_currentPointsList.size()-1; i++) {
- _geometry->addNavLine(_currentPointsList[i],_currentPointsList[i+1],_caption.toStdString());
- }
- clearPoints();
- } else if (qName == "hline") {
- if(_currentPointsList.size()>1)
- {
- for(unsigned int i=0; i<_currentPointsList.size()-1; i++)
- {
- int room_id=-1;
- int subroom_id=-1;
- QStringList lst = _caption.split(":");
- if(lst.length()>2)
- {
- room_id=lst[0].toInt();
- subroom_id=lst[1].toInt();
- _caption=lst[2];
- }
- auto&& geo=_geoFactory.GetElement(room_id,subroom_id);
- if(geo!=nullptr)
- {
- geo->addNavLine(_currentPointsList[i],_currentPointsList[i+1],_caption.toStdString());
- }
- else
- {
+ if (qName == "header") {
+
+ } else if (qName == "agents") {
+ _dataset.setNumberOfAgents(_currentText.toInt());
+ } else if (qName == "frameRate") {
+ _para[0]=_currentText.toFloat();
+ } else if (qName == "wall") {
+ if(_currentPointsList.size()>1)
+ for(unsigned int i=0; i<_currentPointsList.size()-1; i++) {
+ _geometry->addWall(_currentPointsList[i],_currentPointsList[i+1],_caption.toStdString());
+ }
+ clearPoints();
+ } else if (qName == "door") {
+ for(unsigned int i=0; i<_currentPointsList.size()-1; i++) {
+ _geometry->addDoor(_currentPointsList[i],_currentPointsList[i+1],_caption.toStdString());
+ }
+ clearPoints();
+ } else if (qName == "crossing") {
+ if(_currentPointsList.size()>1) //hack
+ for(unsigned int i=0; i<_currentPointsList.size()-1; i++) {
_geometry->addNavLine(_currentPointsList[i],_currentPointsList[i+1],_caption.toStdString());
- }
- }
- }
- clearPoints();
- } else if (qName == "step") {//FIXME
- for(unsigned int i=0; i<_currentPointsList.size()-1; i++) {
- _geometry->addDoor(_currentPointsList[i],_currentPointsList[i+1],_caption.toStdString());
- }
- clearPoints();
- } else if (qName == "frame") {
- Frame* frame = new Frame(_currentFrameID);
- while(!_currentFrame.empty()) {
- frame->addElement(_currentFrame.back());
- _currentFrame.pop_back();
- }
-
- //compute the polydata, might increase the runtime
- frame->ComputePolyData();
-
- _dataset.addFrame(frame);
- //to be on the safe side
- _currentFrame.clear();
-
- } else if (qName == "agent") {
- } else if (qName == "geometry") {
- } else if (qName == "point") {
- } else if (qName == "shape") {
- _dataset.setInitialHeights(_initialPedestriansHeights);
- _dataset.setInitialColors(_initialPedestriansColors);
- } else if (qName == "gradient_field") {
- }
- _currentText.clear();
- return true;
+ }
+ clearPoints();
+ } else if (qName == "hline") {
+ if(_currentPointsList.size()>1)
+ {
+ for(unsigned int i=0; i<_currentPointsList.size()-1; i++)
+ {
+ int room_id=-1;
+ int subroom_id=-1;
+ QStringList lst = _caption.split(":");
+ if(lst.length()>2)
+ {
+ room_id=lst[0].toInt();
+ subroom_id=lst[1].toInt();
+ _caption=lst[2];
+ }
+ auto&& geo=_geoFactory.GetElement(room_id,subroom_id);
+ if(geo!=nullptr)
+ {
+ geo->addNavLine(_currentPointsList[i],_currentPointsList[i+1],_caption.toStdString());
+ }
+ else
+ {
+ _geometry->addNavLine(_currentPointsList[i],_currentPointsList[i+1],_caption.toStdString());
+ }
+ }
+ }
+ clearPoints();
+ } else if (qName == "step") {//FIXME
+ for(unsigned int i=0; i<_currentPointsList.size()-1; i++) {
+ _geometry->addDoor(_currentPointsList[i],_currentPointsList[i+1],_caption.toStdString());
+ }
+ clearPoints();
+ } else if (qName == "frame") {
+ Frame* frame = new Frame(_currentFrameID);
+ while(!_currentFrame.empty()) {
+ frame->addElement(_currentFrame.back());
+ _currentFrame.pop_back();
+ }
+
+ //compute the polydata, might increase the runtime
+ frame->ComputePolyData();
+
+ _dataset.addFrame(frame);
+ //to be on the safe side
+ _currentFrame.clear();
+
+ } else if (qName == "agent") {
+ } else if (qName == "geometry") {
+ } else if (qName == "point") {
+ } else if (qName == "shape") {
+ _dataset.setInitialHeights(_initialPedestriansHeights);
+ _dataset.setInitialColors(_initialPedestriansColors);
+ } else if (qName == "gradient_field") {
+ }
+ _currentText.clear();
+ return true;
}
bool SaxParser::fatalError(const QXmlParseException &exception)
{
- QMessageBox::warning(0, QObject::tr("SAX Handler"), QObject::tr(
- "Parse error at line %1, column "
- "%2:\n%3.") .arg(exception.lineNumber()) .arg(
- exception.columnNumber()) .arg(exception.message()));
- return false;
+ QMessageBox::warning(0, QObject::tr("SAX Handler"), QObject::tr(
+ "Parse error at line %1, column "
+ "%2:\n%3.") .arg(exception.lineNumber()) .arg(
+ exception.columnNumber()) .arg(exception.message()));
+ return false;
}
bool SaxParser::attributeDecl(const QString& eName, const QString& aName,
const QString& type, const QString& valueDefault, const QString& value)
{
- //cout<<aName.toStdString()<<endl;
+ //cout<<aName.toStdString()<<endl;
- QString dummy=eName+aName+type+valueDefault+value;
- return (dummy==dummy);
- //return true;
+ QString dummy=eName+aName+type+valueDefault+value;
+ return (dummy==dummy);
+ //return true;
}
void SaxParser::clearPoints()
{
- while (!_currentPointsList.empty()) {
- delete _currentPointsList.back();
- _currentPointsList.pop_back();
- }
- _currentPointsList.clear();
- return;
+ while (!_currentPointsList.empty()) {
+ delete _currentPointsList.back();
+ _currentPointsList.pop_back();
+ }
+ _currentPointsList.clear();
+ return;
}
/// provided for convenience and will be removed in the next version
@@ -676,186 +677,186 @@ bool SaxParser::parseGeometryJPS(QString fileName, GeometryFactory& geoFac)
{
Debug::Messages( "Enter SaxParser::parseGeometryJPS with filename <%s>",fileName.toStdString().c_str());
- double captionsColor=0;//red
- if(!fileName.endsWith(".xml",Qt::CaseInsensitive)) return false;
- QString wd;
- SystemSettings::getWorkingDirectory(wd);
- fileName=wd + "/" + fileName; //TODO: is this windows compatible?
- // QString = QDir::cleanPath(wd + QDir::separator() + fileName);
- Debug::Messages("filename: <%s)", fileName.toStdString().c_str());
- Debug::Messages("wd: <%s>",wd.toStdString().c_str());
- Debug::Messages("filename2: <%s>",fileName.toStdString().c_str());
- Building* building = new Building();
- string geometrypath = fileName.toStdString();
- // read the geometry
- if(!building->LoadGeometry(geometrypath))
- return false;
- if(!building->InitGeometry())
- return false; // create the polygons
-
- int room_id = -1;
- int subroom_id = -1;
- for(auto&& itr_room: building->GetAllRooms())
- {
- room_id++;
- for(auto&& itr_subroom: itr_room.second->GetAllSubRooms())
- {
- subroom_id++;
- string room_caption = itr_room.second->GetCaption() + "_RId_" + QString::number(itr_room.first).toStdString();
- string subroom_caption = itr_subroom.second->GetCaption()+ "_RId_" + QString::number(itr_room.first).toStdString();
- auto geometry= shared_ptr<FacilityGeometry>(
+ double captionsColor=0;//red
+ if(!fileName.endsWith(".xml",Qt::CaseInsensitive)) return false;
+ QString wd;
+ SystemSettings::getWorkingDirectory(wd);
+ fileName=wd + "/" + fileName; //TODO: is this windows compatible?
+ // QString = QDir::cleanPath(wd + QDir::separator() + fileName);
+ Debug::Messages("filename: <%s)", fileName.toStdString().c_str());
+ Debug::Messages("wd: <%s>",wd.toStdString().c_str());
+ Debug::Messages("filename2: <%s>",fileName.toStdString().c_str());
+ Building* building = new Building();
+ string geometrypath = fileName.toStdString();
+ // read the geometry
+ if(!building->LoadGeometry(geometrypath))
+ return false;
+ if(!building->InitGeometry())
+ return false; // create the polygons
+
+ int room_id = -1;
+ int subroom_id = -1;
+ for(auto&& itr_room: building->GetAllRooms())
+ {
+ room_id++;
+ for(auto&& itr_subroom: itr_room.second->GetAllSubRooms())
+ {
+ subroom_id++;
+ string room_caption = itr_room.second->GetCaption() + "_RId_" + QString::number(itr_room.first).toStdString();
+ string subroom_caption = itr_subroom.second->GetCaption()+ "_RId_" + QString::number(itr_room.first).toStdString();
+ auto geometry= shared_ptr<FacilityGeometry>(
new FacilityGeometry(itr_subroom.second->GetType(), room_caption, subroom_caption
- )
- );
- int currentFloorPolyID=0;
- int currentObstPolyID=0;
-
- // Setup the points
- VTK_CREATE(vtkPoints,floor_points);
- VTK_CREATE(vtkPoints,obstacles_points);
- // Add the polygon to a list of polygons
- VTK_CREATE(vtkCellArray,floor_polygons);
- VTK_CREATE(vtkCellArray,obstacles_polygons);
-
- //string caption = r->GetCaption();
- SubRoom* sub = itr_subroom.second.get();
-
- vector<Point> poly = sub->GetPolygon();
- if(sub->IsClockwise()==true) {
- std::reverse(poly.begin(),poly.end());
- }
-
- // Create the polygon
- VTK_CREATE(vtkPolygon,polygon);
- polygon->GetPointIds()->SetNumberOfIds(poly.size());
-
- for (unsigned int s=0; s<poly.size(); s++) {
- floor_points->InsertNextPoint(poly[s]._x*FAKTOR,poly[s]._y*FAKTOR,sub->GetElevation(poly[s])*FAKTOR);
- polygon->GetPointIds()->SetId(s, currentFloorPolyID++);
- }
- floor_polygons->InsertNextCell(polygon);
-
- //plot the walls only for not stairs
- const vector<Wall>& walls= sub->GetAllWalls();
- for(unsigned int w=0; w<walls.size(); w++) {
- Point p1 = walls[w].GetPoint1();
- Point p2 = walls[w].GetPoint2();
- double z1= sub->GetElevation(p1);
- double z2= sub->GetElevation(p2);
-
- if(sub->GetType()=="stair") {
- geometry->addStair(p1._x*FAKTOR, p1._y*FAKTOR, z1*FAKTOR, p2._x*FAKTOR, p2._y*FAKTOR,z2*FAKTOR);
- } else {
- geometry->addWall(p1._x*FAKTOR, p1._y*FAKTOR, z1*FAKTOR, p2._x*FAKTOR, p2._y*FAKTOR,z2*FAKTOR);
- }
- }
-
- //insert the subroom caption
- string caption=itr_room.second->GetCaption()+" ( " + QString::number(sub->GetSubRoomID()).toStdString() + " ) ";
- const Point& p=sub->GetCentroid();
- double z= sub->GetElevation(p);
- double pos[3]= {p._x*FAKTOR,p._y*FAKTOR,z*FAKTOR};
- geometry->addObjectLabel(pos,pos,caption,captionsColor);
-
- //plot the obstacles
- for(auto obst:sub->GetAllObstacles())
- {
- for(auto wall: obst->GetAllWalls())
- {
- Point p1 = wall.GetPoint1();
- Point p2 = wall.GetPoint2();
+ )
+ );
+ int currentFloorPolyID=0;
+ int currentObstPolyID=0;
+
+ // Setup the points
+ VTK_CREATE(vtkPoints,floor_points);
+ VTK_CREATE(vtkPoints,obstacles_points);
+ // Add the polygon to a list of polygons
+ VTK_CREATE(vtkCellArray,floor_polygons);
+ VTK_CREATE(vtkCellArray,obstacles_polygons);
+
+ //string caption = r->GetCaption();
+ SubRoom* sub = itr_subroom.second.get();
+
+ vector<Point> poly = sub->GetPolygon();
+ if(sub->IsClockwise()==true) {
+ std::reverse(poly.begin(),poly.end());
+ }
+
+ // Create the polygon
+ VTK_CREATE(vtkPolygon,polygon);
+ polygon->GetPointIds()->SetNumberOfIds(poly.size());
+
+ for (unsigned int s=0; s<poly.size(); s++) {
+ floor_points->InsertNextPoint(poly[s]._x*FAKTOR,poly[s]._y*FAKTOR,sub->GetElevation(poly[s])*FAKTOR);
+ polygon->GetPointIds()->SetId(s, currentFloorPolyID++);
+ }
+ floor_polygons->InsertNextCell(polygon);
+
+ //plot the walls only for not stairs
+ const vector<Wall>& walls= sub->GetAllWalls();
+ for(unsigned int w=0; w<walls.size(); w++) {
+ Point p1 = walls[w].GetPoint1();
+ Point p2 = walls[w].GetPoint2();
double z1= sub->GetElevation(p1);
double z2= sub->GetElevation(p2);
- geometry->addWall(p1._x*FAKTOR, p1._y*FAKTOR, z1*FAKTOR, p2._x*FAKTOR, p2._y*FAKTOR,z2*FAKTOR);
- }
- //add the obstacle caption
- const Point& p=obst->GetCentroid();
- double z= sub->GetElevation(p);
- double pos[3]= {p._x*FAKTOR,p._y*FAKTOR,z*FAKTOR};
- geometry->addObjectLabel(pos,pos,obst->GetCaption(),captionsColor);
-
- //add a special texture to the obstacles
- auto poly = obst->GetPolygon();
- //if(obst->IsClockwise()==true) {
- // std::reverse(poly.begin(),poly.end());
- //}
-
- // Create the polygon
- VTK_CREATE(vtkPolygon,polygon);
- polygon->GetPointIds()->SetNumberOfIds(poly.size());
-
- for (unsigned int s=0; s<poly.size(); s++) {
- obstacles_points->InsertNextPoint(poly[s]._x*FAKTOR,poly[s]._y*FAKTOR,sub->GetElevation(poly[s])*FAKTOR);
- polygon->GetPointIds()->SetId(s, currentObstPolyID++);
- }
- obstacles_polygons->InsertNextCell(polygon);
- }
- // Create a PolyData to represent the floor
- VTK_CREATE(vtkPolyData, floorPolygonPolyData);
- floorPolygonPolyData->SetPoints(floor_points);
- floorPolygonPolyData->SetPolys(floor_polygons);
- geometry->addFloor(floorPolygonPolyData);
-
- // Create a PolyData to represen the obstacles
- VTK_CREATE(vtkPolyData, obstPolygonPolyData);
- obstPolygonPolyData->SetPoints(obstacles_points);
- obstPolygonPolyData->SetPolys(obstacles_polygons);
- geometry->addObstacles(obstPolygonPolyData);
-
- // add the crossings
- for(auto&& cr: itr_subroom.second->GetAllCrossings())
- {
- Point p1 = cr->GetPoint1();
- Point p2 = cr->GetPoint2();
- double z1= cr->GetSubRoom1()->GetElevation(p1);
- double z2= cr->GetSubRoom1()->GetElevation(p2);
- geometry->addNavLine(p1._x*FAKTOR, p1._y*FAKTOR, z1*FAKTOR, p2._x*FAKTOR, p2._y*FAKTOR,z2*FAKTOR);
-
- const Point& p =cr->GetCentre();
- double pos[3]= {p._x*FAKTOR,p._y*FAKTOR,z1*FAKTOR};
- geometry->addObjectLabel(pos,pos,"nav_"+QString::number(cr->GetID()).toStdString()+"_"+
- QString::number(cr->GetUniqueID()).toStdString()
- ,captionsColor);
- }
+ if(sub->GetType()=="stair") {
+ geometry->addStair(p1._x*FAKTOR, p1._y*FAKTOR, z1*FAKTOR, p2._x*FAKTOR, p2._y*FAKTOR,z2*FAKTOR);
+ } else {
+ geometry->addWall(p1._x*FAKTOR, p1._y*FAKTOR, z1*FAKTOR, p2._x*FAKTOR, p2._y*FAKTOR,z2*FAKTOR);
+ }
+ }
+
+ //insert the subroom caption
+ string caption=itr_room.second->GetCaption()+" ( " + QString::number(sub->GetSubRoomID()).toStdString() + " ) ";
+ const Point& p=sub->GetCentroid();
+ double z= sub->GetElevation(p);
+ double pos[3]= {p._x*FAKTOR,p._y*FAKTOR,z*FAKTOR};
+ geometry->addObjectLabel(pos,pos,caption,captionsColor);
+
+ //plot the obstacles
+ for(auto obst:sub->GetAllObstacles())
+ {
+ for(auto wall: obst->GetAllWalls())
+ {
+ Point p1 = wall.GetPoint1();
+ Point p2 = wall.GetPoint2();
+ double z1= sub->GetElevation(p1);
+ double z2= sub->GetElevation(p2);
+ geometry->addWall(p1._x*FAKTOR, p1._y*FAKTOR, z1*FAKTOR, p2._x*FAKTOR, p2._y*FAKTOR,z2*FAKTOR);
+ }
+ //add the obstacle caption
+ const Point& p=obst->GetCentroid();
+ double z= sub->GetElevation(p);
+ double pos[3]= {p._x*FAKTOR,p._y*FAKTOR,z*FAKTOR};
+ geometry->addObjectLabel(pos,pos,obst->GetCaption(),captionsColor);
+
+ //add a special texture to the obstacles
+ auto poly = obst->GetPolygon();
+ //if(obst->IsClockwise()==true) {
+ // std::reverse(poly.begin(),poly.end());
+ //}
+
+ // Create the polygon
+ VTK_CREATE(vtkPolygon,polygon);
+ polygon->GetPointIds()->SetNumberOfIds(poly.size());
+
+ for (unsigned int s=0; s<poly.size(); s++) {
+ obstacles_points->InsertNextPoint(poly[s]._x*FAKTOR,poly[s]._y*FAKTOR,sub->GetElevation(poly[s])*FAKTOR);
+ polygon->GetPointIds()->SetId(s, currentObstPolyID++);
+ }
+ obstacles_polygons->InsertNextCell(polygon);
+ }
+
+ // Create a PolyData to represent the floor
+ VTK_CREATE(vtkPolyData, floorPolygonPolyData);
+ floorPolygonPolyData->SetPoints(floor_points);
+ floorPolygonPolyData->SetPolys(floor_polygons);
+ geometry->addFloor(floorPolygonPolyData);
+
+ // Create a PolyData to represen the obstacles
+ VTK_CREATE(vtkPolyData, obstPolygonPolyData);
+ obstPolygonPolyData->SetPoints(obstacles_points);
+ obstPolygonPolyData->SetPolys(obstacles_polygons);
+ geometry->addObstacles(obstPolygonPolyData);
+
+ // add the crossings
+ for(auto&& cr: itr_subroom.second->GetAllCrossings())
+ {
+ Point p1 = cr->GetPoint1();
+ Point p2 = cr->GetPoint2();
+ double z1= cr->GetSubRoom1()->GetElevation(p1);
+ double z2= cr->GetSubRoom1()->GetElevation(p2);
+ geometry->addNavLine(p1._x*FAKTOR, p1._y*FAKTOR, z1*FAKTOR, p2._x*FAKTOR, p2._y*FAKTOR,z2*FAKTOR);
+
+ const Point& p =cr->GetCentre();
+ double pos[3]= {p._x*FAKTOR,p._y*FAKTOR,z1*FAKTOR};
+ geometry->addObjectLabel(pos,pos,"nav_"+QString::number(cr->GetID()).toStdString()+"_"+
+ QString::number(cr->GetUniqueID()).toStdString()
+ ,captionsColor);
+ }
+
+ // add the exits
+ for(auto&& tr: itr_subroom.second->GetAllTransitions())
+ {
+ Point p1 = tr->GetPoint1();
+ Point p2 = tr->GetPoint2();
+ double z1 = 0;
+ double z2 = 0;
+
+ if(tr->GetSubRoom1()) // get elevation for both points
+ {
+ z2 = tr->GetSubRoom1()->GetElevation(p2);
+ z1 = tr->GetSubRoom1()->GetElevation(p1);
+ }
+ else if(! tr->GetSubRoom2())
+ {
+ z2 = tr->GetSubRoom2()->GetElevation(p2);
+ z1 = tr->GetSubRoom2()->GetElevation(p1);
+ }
+ else
+ std::cout << "ERROR: Can not calculate elevations for transition " << tr->GetID() << ", " << tr->GetCaption() << ". Both subrooms are not defined \n";
- // add the exits
- for(auto&& tr: itr_subroom.second->GetAllTransitions())
- {
- Point p1 = tr->GetPoint1();
- Point p2 = tr->GetPoint2();
- double z1 = 0;
- double z2 = 0;
-
- if(tr->GetSubRoom1()) // get elevation for both points
- {
- z2 = tr->GetSubRoom1()->GetElevation(p2);
- z1 = tr->GetSubRoom1()->GetElevation(p1);
- }
- else if(! tr->GetSubRoom2())
- {
- z2 = tr->GetSubRoom2()->GetElevation(p2);
- z1 = tr->GetSubRoom2()->GetElevation(p1);
- }
- else
- std::cout << "ERROR: Can not calculate elevations for transition " << tr->GetID() << ", " << tr->GetCaption() << ". Both subrooms are not defined \n";
-
- geometry->addDoor(p1._x*FAKTOR, p1._y*FAKTOR, z1*FAKTOR, p2._x*FAKTOR, p2._y*FAKTOR,z2*FAKTOR);
-
- const Point& p =tr->GetCentre();
- double pos[3]= {p._x*FAKTOR,p._y*FAKTOR,z1*FAKTOR};
- geometry->addObjectLabel(pos,pos,"door_"+QString::number(tr->GetID()).toStdString()+
- +"_"+ QString::number(tr->GetUniqueID()).toStdString(),captionsColor);
- }
+ geometry->addDoor(p1._x*FAKTOR, p1._y*FAKTOR, z1*FAKTOR, p2._x*FAKTOR, p2._y*FAKTOR,z2*FAKTOR);
- geoFac.AddElement(room_id,subroom_id,geometry);
- }
- }
+ const Point& p =tr->GetCentre();
+ double pos[3]= {p._x*FAKTOR,p._y*FAKTOR,z1*FAKTOR};
+ geometry->addObjectLabel(pos,pos,"door_"+QString::number(tr->GetID()).toStdString()+
+ +"_"+ QString::number(tr->GetUniqueID()).toStdString(),captionsColor);
+ }
+ geoFac.AddElement(room_id,subroom_id,geometry);
+ }
+ }
- // free memory
- delete building;
- return true;
+
+ // free memory
+ delete building;
+ return true;
}
/// provided for convenience and will be removed in the next version
@@ -863,109 +864,80 @@ bool SaxParser::parseGeometryJPS(QString fileName, GeometryFactory& geoFac)
void SaxParser::parseGeometryTRAV(QString content, GeometryFactory& geoFac,QDomNode geo)
{
- cout<<"external geometry found"<<endl;
- //creating am empty document
- // to be filled
- QDomDocument doc("");
- QDomNode geoNode;
- auto geometry= shared_ptr<FacilityGeometry>(new FacilityGeometry("no name", "no name", "no name"));
-
- //first try to open the file
- if(content.endsWith(".trav",Qt::CaseInsensitive) ) {
- QFile file(content);
- if (!file.open(QIODevice::ReadOnly)) {
- //slotErrorOutput("could not open the File" );
- cout<<"could not open the File"<<endl;
- return ;
- }
- QString *errorCode = new QString();
- if (!doc.setContent(&file, errorCode)) {
- file.close();
- //slotErrorOutput(*errorCode);
- cout<<errorCode->toStdString()<<endl;
- return ;
- }
- file.close();
- geoNode =doc.documentElement().namedItem("geometry");
-
- if (geoNode.isNull()) {
- cout<<"No geometry information found. <geometry> <geometry/> tag is missing."<<endl;
- }
- } else {
- if(content.isEmpty()) {
- geoNode=geo;
- cout <<"parsing the old fashion way"<<endl;
- } else {
- content = "<travisto>\n" +content+ "\n</travisto>\n";
- QString errorMsg="";
- doc.setContent(content,&errorMsg);
-
- if(!errorMsg.isEmpty()) {
- Debug::Error("%s", (const char *)errorMsg.toStdString().c_str());
- return;
- }
- geoNode =doc.elementsByTagName("geometry").item(0);
- }
- }
-
- // for the case there is more than just one geometry Node
- while (!geoNode.isNull()) {
- QDomElement e = geoNode.toElement();
- QDomNodeList walls = e.elementsByTagName("wall");
- QDomNodeList doors = e.elementsByTagName("door");
-
- //objects which can be positioned everywhere in the facility
- QDomNodeList spheres = e.elementsByTagName("sphere");
- QDomNodeList cuboids = e.elementsByTagName("cuboid");
- QDomNodeList floors = e.elementsByTagName("floor");
- QDomNodeList cylinders = e.elementsByTagName("cylinder");
- QDomNodeList labels = e.elementsByTagName("label");
-
-
- //parsing the walls
- for ( int i = 0; i < walls.length(); i++) {
- QDomElement el = walls.item(i).toElement();
-
- //wall thickness, default to 30 cm
- double thickness = el.attribute("thickness","15").toDouble()*FAKTOR;
- //wall height default to 250 cm
- double height = el.attribute("height","250").toDouble()*FAKTOR;
- //wall color default to blue
- double color = el.attribute("color","0").toDouble();
-
- //get the points defining each wall
- //not that a wall is not necessarily defined by two points, could be more...
- QDomNodeList points = el.elementsByTagName("point");
- for ( int i = 0; i < points.length() - 1; i++) {
-
- double x1=points.item(i).toElement().attribute("xPos", "0").toDouble()*FAKTOR;
- double y1=points.item(i).toElement().attribute("yPos", "0").toDouble()*FAKTOR;
- double z1=points.item(i).toElement().attribute("zPos", "0").toDouble()*FAKTOR;
-
- double x2=points.item(i+1).toElement().attribute("xPos", "0").toDouble()*FAKTOR;
- double y2=points.item(i+1).toElement().attribute("yPos", "0").toDouble()*FAKTOR;
- double z2=points.item(i+1).toElement().attribute("zPos", "0").toDouble()*FAKTOR;
- geometry->addWall(x1, y1,z1 ,x2, y2,z2,thickness,height,color);
- }
- }
-
- //parsing the doors
- if(doors.length()>0)
- for ( int i = 0; i < doors.length(); i++) {
- QDomElement el = doors.item(i).toElement();
-
- //door thickness, default to 15 cm
- double thickness = el.attribute("thickness","15").toDouble()*FAKTOR;
- //door height default to 250 cm
- double height = el.attribute("height","250").toDouble()*FAKTOR;
- //door color default to blue
- double color = el.attribute("color","255").toDouble();
-
- //get the points defining each wall
- //not that a wall is not necesarily defined by two points, could be more...
- QDomNodeList points = el.elementsByTagName("point");
- //Debug::Messages("found: " << points.length() <<" for this wall" <<endl;
- for ( int i = 0; i < points.length() - 1; i++) {
+ cout<<"external geometry found"<<endl;
+ //creating am empty document
+ // to be filled
+ QDomDocument doc("");
+ QDomNode geoNode;
+ auto geometry= shared_ptr<FacilityGeometry>(new FacilityGeometry("no name", "no name", "no name"));
+
+ //first try to open the file
+ if(content.endsWith(".trav",Qt::CaseInsensitive) ) {
+ QFile file(content);
+ if (!file.open(QIODevice::ReadOnly)) {
+ //slotErrorOutput("could not open the File" );
+ cout<<"could not open the File"<<endl;
+ return ;
+ }
+ QString *errorCode = new QString();
+ if (!doc.setContent(&file, errorCode)) {
+ file.close();
+ //slotErrorOutput(*errorCode);
+ cout<<errorCode->toStdString()<<endl;
+ return ;
+ }
+ file.close();
+ geoNode =doc.documentElement().namedItem("geometry");
+
+ if (geoNode.isNull()) {
+ cout<<"No geometry information found. <geometry> <geometry/> tag is missing."<<endl;
+ }
+ } else {
+ if(content.isEmpty()) {
+ geoNode=geo;
+ cout <<"parsing the old fashion way"<<endl;
+ } else {
+ content = "<travisto>\n" +content+ "\n</travisto>\n";
+ QString errorMsg="";
+ doc.setContent(content,&errorMsg);
+
+ if(!errorMsg.isEmpty()) {
+ Debug::Error("%s", (const char *)errorMsg.toStdString().c_str());
+ return;
+ }
+ geoNode =doc.elementsByTagName("geometry").item(0);
+ }
+ }
+
+ // for the case there is more than just one geometry Node
+ while (!geoNode.isNull()) {
+ QDomElement e = geoNode.toElement();
+ QDomNodeList walls = e.elementsByTagName("wall");
+ QDomNodeList doors = e.elementsByTagName("door");
+
+ //objects which can be positioned everywhere in the facility
+ QDomNodeList spheres = e.elementsByTagName("sphere");
+ QDomNodeList cuboids = e.elementsByTagName("cuboid");
+ QDomNodeList floors = e.elementsByTagName("floor");
+ QDomNodeList cylinders = e.elementsByTagName("cylinder");
+ QDomNodeList labels = e.elementsByTagName("label");
+
+
+ //parsing the walls
+ for ( int i = 0; i < walls.length(); i++) {
+ QDomElement el = walls.item(i).toElement();
+
+ //wall thickness, default to 30 cm
+ double thickness = el.attribute("thickness","15").toDouble()*FAKTOR;
+ //wall height default to 250 cm
+ double height = el.attribute("height","250").toDouble()*FAKTOR;
+ //wall color default to blue
+ double color = el.attribute("color","0").toDouble();
+
+ //get the points defining each wall
+ //not that a wall is not necessarily defined by two points, could be more...
+ QDomNodeList points = el.elementsByTagName("point");
+ for ( int i = 0; i < points.length() - 1; i++) {
double x1=points.item(i).toElement().attribute("xPos", "0").toDouble()*FAKTOR;
double y1=points.item(i).toElement().attribute("yPos", "0").toDouble()*FAKTOR;
@@ -974,543 +946,572 @@ void SaxParser::parseGeometryTRAV(QString content, GeometryFactory& geoFac,QDomN
double x2=points.item(i+1).toElement().attribute("xPos", "0").toDouble()*FAKTOR;
double y2=points.item(i+1).toElement().attribute("yPos", "0").toDouble()*FAKTOR;
double z2=points.item(i+1).toElement().attribute("zPos", "0").toDouble()*FAKTOR;
- geometry->addDoor(x1, y1, z1, x2, y2,z2,thickness,height,color);
- }
- }
-
- // parsing the objets
- for ( int i = 0; i < spheres.length(); i++) {
-
- double center[3];
- center[0] = spheres.item(i).toElement().attribute("centerX", "0").toDouble()*FAKTOR;
- center[1]= spheres.item(i).toElement().attribute("centerY", "0").toDouble()*FAKTOR;
- center[2]= spheres.item(i).toElement().attribute("centerZ", "0").toDouble()*FAKTOR;
- double color= spheres.item(i).toElement().attribute("color", "0").toDouble()*FAKTOR;
- double radius= spheres.item(i).toElement().attribute("radius", "0").toDouble()*FAKTOR;
- //double width = spheres.item(i).toElement().attribute("width", "0").toDouble();
- //double height= spheres.item(i).toElement().attribute("height", "0").toDouble();
-
- geometry->addObjectSphere(center,radius,color);
- }
- // cubic shapes
- for ( int i = 0; i < cuboids.length(); i++) {
-
- double center[3];
- center[0] = cuboids.item(i).toElement().attribute("centerX", "0").toDouble()*FAKTOR;
- center[1]= cuboids.item(i).toElement().attribute("centerY", "0").toDouble()*FAKTOR;
- center[2]= cuboids.item(i).toElement().attribute("centerZ", "0").toDouble()*FAKTOR;
- double color= cuboids.item(i).toElement().attribute("color", "0").toDouble();
- double length= cuboids.item(i).toElement().attribute("length", "0").toDouble()*FAKTOR;
- double width = cuboids.item(i).toElement().attribute("width", "0").toDouble()*FAKTOR;
- double height= cuboids.item(i).toElement().attribute("height", "0").toDouble()*FAKTOR;
- geometry->addObjectBox(center,height,width,length,color);
- // Debug::Error("cuboids: "<<length<<" || " <<width << " || "<<height<<" || "<<color<<endl;
- }
- // floors
- for ( int i = 0; i < floors.length(); i++) {
-
- double left =floors.item(i).toElement().attribute("xMin","0").toDouble()*FAKTOR;
- double right =floors.item(i).toElement().attribute("xMax","0").toDouble()*FAKTOR;
- double up =floors.item(i).toElement().attribute("yMax","0").toDouble()*FAKTOR;
- double down =floors.item(i).toElement().attribute("yMin","0").toDouble()*FAKTOR;
- double z =floors.item(i).toElement().attribute("z","0").toDouble()*FAKTOR;
- geometry->addFloor(left,down,right,up,z);
- }
- // cylinders
- for ( int i = 0; i < cylinders.length(); i++) {
-
- double center[3], rotation[3];
- center[0] = cylinders.item(i).toElement().attribute("centerX", "0").toDouble()*FAKTOR;
- center[1]= cylinders.item(i).toElement().attribute("centerY", "0").toDouble()*FAKTOR;
- center[2]= cylinders.item(i).toElement().attribute("centerZ", "0").toDouble()*FAKTOR;
- double color= cylinders.item(i).toElement().attribute("color", "0").toDouble();
- double radius= cylinders.item(i).toElement().attribute("radius", "0").toDouble()*FAKTOR;
- double height= cylinders.item(i).toElement().attribute("height", "0").toDouble()*FAKTOR;
- rotation[0] = cylinders.item(i).toElement().attribute("angleX", "90").toDouble();
- rotation[1] = cylinders.item(i).toElement().attribute("angleY", "0").toDouble();
- rotation[2] = cylinders.item(i).toElement().attribute("angleZ", "0").toDouble();
- geometry->addObjectCylinder(center,radius,height,rotation,color);
- }
-
- //Labels
- for ( int i = 0; i < labels.length(); i++) {
-
- double center[3];
- center[0] = labels.item(i).toElement().attribute("centerX", "0").toDouble()*FAKTOR;
- center[1]= labels.item(i).toElement().attribute("centerY", "0").toDouble()*FAKTOR;
- center[2]= labels.item(i).toElement().attribute("centerZ", "0").toDouble()*FAKTOR;
- double color= labels.item(i).toElement().attribute("color", "0").toDouble();
- string caption= labels.item(i).toElement().attribute("text", "").toStdString();
- geometry->addObjectLabel(center,center,caption,color);
- }
- // you should normally have only one geometry node, but one never knows...
- geoNode = geoNode.nextSiblingElement("geometry");
- }
-
- geoFac.AddElement(0,0,geometry);
+ geometry->addWall(x1, y1,z1 ,x2, y2,z2,thickness,height,color);
+ }
+ }
+
+ //parsing the doors
+ if(doors.length()>0)
+ for ( int i = 0; i < doors.length(); i++) {
+ QDomElement el = doors.item(i).toElement();
+
+ //door thickness, default to 15 cm
+ double thickness = el.attribute("thickness","15").toDouble()*FAKTOR;
+ //door height default to 250 cm
+ double height = el.attribute("height","250").toDouble()*FAKTOR;
+ //door color default to blue
+ double color = el.attribute("color","255").toDouble();
+
+ //get the points defining each wall
+ //not that a wall is not necesarily defined by two points, could be more...
+ QDomNodeList points = el.elementsByTagName("point");
+ //Debug::Messages("found: " << points.length() <<" for this wall" <<endl;
+ for ( int i = 0; i < points.length() - 1; i++) {
+
+ double x1=points.item(i).toElement().attribute("xPos", "0").toDouble()*FAKTOR;
+ double y1=points.item(i).toElement().attribute("yPos", "0").toDouble()*FAKTOR;
+ double z1=points.item(i).toElement().attribute("zPos", "0").toDouble()*FAKTOR;
+
+ double x2=points.item(i+1).toElement().attribute("xPos", "0").toDouble()*FAKTOR;
+ double y2=points.item(i+1).toElement().attribute("yPos", "0").toDouble()*FAKTOR;
+ double z2=points.item(i+1).toElement().attribute("zPos", "0").toDouble()*FAKTOR;
+ geometry->addDoor(x1, y1, z1, x2, y2,z2,thickness,height,color);
+ }
+ }
+
+ // parsing the objets
+ for ( int i = 0; i < spheres.length(); i++) {
+
+ double center[3];
+ center[0] = spheres.item(i).toElement().attribute("centerX", "0").toDouble()*FAKTOR;
+ center[1]= spheres.item(i).toElement().attribute("centerY", "0").toDouble()*FAKTOR;
+ center[2]= spheres.item(i).toElement().attribute("centerZ", "0").toDouble()*FAKTOR;
+ double color= spheres.item(i).toElement().attribute("color", "0").toDouble()*FAKTOR;
+ double radius= spheres.item(i).toElement().attribute("radius", "0").toDouble()*FAKTOR;
+ //double width = spheres.item(i).toElement().attribute("width", "0").toDouble();
+ //double height= spheres.item(i).toElement().attribute("height", "0").toDouble();
+
+ geometry->addObjectSphere(center,radius,color);
+ }
+ // cubic shapes
+ for ( int i = 0; i < cuboids.length(); i++) {
+
+ double center[3];
+ center[0] = cuboids.item(i).toElement().attribute("centerX", "0").toDouble()*FAKTOR;
+ center[1]= cuboids.item(i).toElement().attribute("centerY", "0").toDouble()*FAKTOR;
+ center[2]= cuboids.item(i).toElement().attribute("centerZ", "0").toDouble()*FAKTOR;
+ double color= cuboids.item(i).toElement().attribute("color", "0").toDouble();
+ double length= cuboids.item(i).toElement().attribute("length", "0").toDouble()*FAKTOR;
+ double width = cuboids.item(i).toElement().attribute("width", "0").toDouble()*FAKTOR;
+ double height= cuboids.item(i).toElement().attribute("height", "0").toDouble()*FAKTOR;
+ geometry->addObjectBox(center,height,width,length,color);
+ // Debug::Error("cuboids: "<<length<<" || " <<width << " || "<<height<<" || "<<color<<endl;
+ }
+ // floors
+ for ( int i = 0; i < floors.length(); i++) {
+
+ double left =floors.item(i).toElement().attribute("xMin","0").toDouble()*FAKTOR;
+ double right =floors.item(i).toElement().attribute("xMax","0").toDouble()*FAKTOR;
+ double up =floors.item(i).toElement().attribute("yMax","0").toDouble()*FAKTOR;
+ double down =floors.item(i).toElement().attribute("yMin","0").toDouble()*FAKTOR;
+ double z =floors.item(i).toElement().attribute("z","0").toDouble()*FAKTOR;
+ geometry->addFloor(left,down,right,up,z);
+ }
+ // cylinders
+ for ( int i = 0; i < cylinders.length(); i++) {
+
+ double center[3], rotation[3];
+ center[0] = cylinders.item(i).toElement().attribute("centerX", "0").toDouble()*FAKTOR;
+ center[1]= cylinders.item(i).toElement().attribute("centerY", "0").toDouble()*FAKTOR;
+ center[2]= cylinders.item(i).toElement().attribute("centerZ", "0").toDouble()*FAKTOR;
+ double color= cylinders.item(i).toElement().attribute("color", "0").toDouble();
+ double radius= cylinders.item(i).toElement().attribute("radius", "0").toDouble()*FAKTOR;
+ double height= cylinders.item(i).toElement().attribute("height", "0").toDouble()*FAKTOR;
+ rotation[0] = cylinders.item(i).toElement().attribute("angleX", "90").toDouble();
+ rotation[1] = cylinders.item(i).toElement().attribute("angleY", "0").toDouble();
+ rotation[2] = cylinders.item(i).toElement().attribute("angleZ", "0").toDouble();
+ geometry->addObjectCylinder(center,radius,height,rotation,color);
+ }
+
+ //Labels
+ for ( int i = 0; i < labels.length(); i++) {
+
+ double center[3];
+ center[0] = labels.item(i).toElement().attribute("centerX", "0").toDouble()*FAKTOR;
+ center[1]= labels.item(i).toElement().attribute("centerY", "0").toDouble()*FAKTOR;
+ center[2]= labels.item(i).toElement().attribute("centerZ", "0").toDouble()*FAKTOR;
+ double color= labels.item(i).toElement().attribute("color", "0").toDouble();
+ string caption= labels.item(i).toElement().attribute("text", "").toStdString();
+ geometry->addObjectLabel(center,center,caption,color);
+ }
+ // you should normally have only one geometry node, but one never knows...
+ geoNode = geoNode.nextSiblingElement("geometry");
+ }
+
+ geoFac.AddElement(0,0,geometry);
}
QString SaxParser::extractGeometryFilename(QString &filename)
{
- QString extracted_geo_name="";
- //first try to look at a string <file location="filename.xml"/>
- QFile file(filename);
- QString line;
- if (file.open(QIODevice::ReadOnly | QIODevice::Text)) {
- QTextStream in(&file);
- while (!in.atEnd()) {
- //look for a line with
- line = in.readLine();
- //cout<<"checking: "<<line.toStdString()<<endl;
- if(line.contains("location" ,Qt::CaseInsensitive))
- if(line.contains("<file" ,Qt::CaseInsensitive)) {
- //try to extract what ever is inside the quotes
-
- QString begin="\"";
- QString end="\"";
- int startIndex = line.indexOf(begin)+begin.length();
- if(startIndex <= 0)continue; //false alarm
- int endIndex = line.indexOf(end,startIndex);
- if(endIndex <= 0)continue; // false alarm
- extracted_geo_name= line.mid(startIndex,endIndex - startIndex);
- return extracted_geo_name;
- //break;// we are done
- }
- if(line.contains("<geometry" ,Qt::CaseInsensitive))
- if(line.contains("version" ,Qt::CaseInsensitive)) {
- //real geometry file
- QFileInfo fileInfoGeometry(filename);
- extracted_geo_name=fileInfoGeometry.fileName();
- return extracted_geo_name;
- }
- }
- }
-
- //maybe this is already the geometry file itself ?
- //do a rapid test
- // FacilityGeometry* geo = new FacilityGeometry();
- // QFileInfo fileInfoGeometry(filename);
- // extracted_geo_name=fileInfoGeometry.fileName();
-
- // //just check if it starts with geometry
- // //if(parseGeometryJPS(extracted_geo_name,geo)==true)
- // //{
- // return extracted_geo_name;
- // //}
- // delete geo;
-
- return "";
+ QString extracted_geo_name="";
+ //first try to look at a string <file location="filename.xml"/>
+ QFile file(filename);
+ QString line;
+ if (file.open(QIODevice::ReadOnly | QIODevice::Text)) {
+ QTextStream in(&file);
+ while (!in.atEnd()) {
+ //look for a line with
+ line = in.readLine();
+ //cout<<"checking: "<<line.toStdString()<<endl;
+ if(line.contains("location" ,Qt::CaseInsensitive))
+ if(line.contains("<file" ,Qt::CaseInsensitive)) {
+ //try to extract what ever is inside the quotes
+
+ QString begin="\"";
+ QString end="\"";
+ int startIndex = line.indexOf(begin)+begin.length();
+ if(startIndex <= 0)continue; //false alarm
+ int endIndex = line.indexOf(end,startIndex);
+ if(endIndex <= 0)continue; // false alarm
+ extracted_geo_name= line.mid(startIndex,endIndex - startIndex);
+ return extracted_geo_name;
+ //break;// we are done
+ }
+ if(line.contains("<geometry" ,Qt::CaseInsensitive))
+ if(line.contains("version" ,Qt::CaseInsensitive)) {
+ //real geometry file
+ QFileInfo fileInfoGeometry(filename);
+ extracted_geo_name=fileInfoGeometry.fileName();
+ return extracted_geo_name;
+ }
+ }
+ }
+
+ //maybe this is already the geometry file itself ?
+ //do a rapid test
+ // FacilityGeometry* geo = new FacilityGeometry();
+ // QFileInfo fileInfoGeometry(filename);
+ // extracted_geo_name=fileInfoGeometry.fileName();
+
+ // //just check if it starts with geometry
+ // //if(parseGeometryJPS(extracted_geo_name,geo)==true)
+ // //{
+ // return extracted_geo_name;
+ // //}
+ // delete geo;
+
+ return "";
}
void SaxParser::parseGeometryXMLV04(QString filename, GeometryFactory& geoFac)
{
- cout << "parsing 04\n" ;
- QDomDocument doc("");
- QFile file(filename);
-
- int size =file.size()/(1024*1024);
-
- //avoid dom parsing a very large dataset
- if(size>500) {
- //cout<<"The file is too large: "<<filename.toStdString()<<endl;
- return;
- }
-
- auto geo= shared_ptr<FacilityGeometry>(new FacilityGeometry("no name", "no name", "no name"));
- //cout<<"filename: "<<filename.toStdString()<<endl;
-
- //TODO: check if you can parse this with the building classes.
- // This should be a fall back option
-
- if (!file.open(QIODevice::ReadOnly)) {
- qDebug()<<"could not open the file: "<<filename<<endl;
- return ;
- }
- QString *errorCode = new QString();
- if (!doc.setContent(&file, errorCode)) {
- file.close();
- qDebug()<<errorCode<<endl;
- return ;
- }
- QDomElement root= doc.documentElement();
-
- //only parsing the geometry node
- if(root.tagName()!="geometry") return;
-
-
- double version =root.attribute("version","-1").toDouble();
-
- string unit=root.attribute("unit","cm").toStdString();
- double xToCmfactor=100;
- if (unit=="cm") xToCmfactor=1;
- if (unit=="m") xToCmfactor=100;
-
- if(version<0.4) {
- QMessageBox::warning(0, QObject::tr("Parsing Error"),
- QObject::tr("Only geometry version >= 0.4 supported"));
- }
-
- //parsing the subrooms
- QDomNodeList xSubRoomsNodeList=doc.elementsByTagName("subroom");
- //parsing the walls
- for ( int i = 0; i < xSubRoomsNodeList.length(); i++) {
- QDomElement xPoly = xSubRoomsNodeList.item(i).firstChildElement("polygon");
- double position[3]= {0,0,0};
- double pos_count=1;
- double color=0;
-
- while(!xPoly.isNull()) {
- //wall thickness, default to 30 cm
- double thickness = xPoly.attribute("thickness","15").toDouble();
- //wall height default to 250 cm
- double height = xPoly.attribute("height","250").toDouble();
- //wall color default to blue
- color = xPoly.attribute("color","0").toDouble();
-
- QDomNodeList xVertices=xPoly.elementsByTagName("vertex");
- pos_count+=xVertices.count()-1;
-
- for( int i=0; i<xVertices.count()-1; i++) {
- //all unit are converted in cm
- double x1=xVertices.item(i).toElement().attribute("px", "0").toDouble()*xToCmfactor;
- double y1=xVertices.item(i).toElement().attribute("py", "0").toDouble()*xToCmfactor;
- double z1=xVertices.item(i).toElement().attribute("pz", "0").toDouble()*xToCmfactor;
- double x2=xVertices.item(i+1).toElement().attribute("px", "0").toDouble()*xToCmfactor;
- double y2=xVertices.item(i+1).toElement().attribute("py", "0").toDouble()*xToCmfactor;
- double z2=xVertices.item(i+1).toElement().attribute("pz", "0").toDouble()*xToCmfactor;
-
- position[0]+= x1;
- position[1]+= y1;
- position[2]+= z1;
-
- geo->addWall(x1, y1, z1, x2, y2,z2,thickness,height,color);
- }
- xPoly = xPoly.nextSiblingElement("polygon");
- }
-
- //add the caption
- string roomCaption = xSubRoomsNodeList.item(i).parentNode().toElement().attribute("caption").toStdString();
- string subroomCaption=xSubRoomsNodeList.item(i).toElement().attribute("id").toStdString();
- string caption=roomCaption+" ( " + subroomCaption + " ) ";
- position[0]/=pos_count;
- position[1]/=pos_count;
- position[2]/=pos_count;
- geo->addObjectLabel(position,position,caption,color);
- geo->SetRoomCaption(roomCaption);
- geo->SetSubRoomCaption(subroomCaption);
- cout<<"position: [" <<position[0]<<", "<<position[1]<<", "<<position[2]<<" ]"<<endl;;
- cout << roomCaption<< " " << subroomCaption << "\n" ;
- }
-
- QDomNodeList xObstaclesList=doc.elementsByTagName("obstacle");
- for ( int i = 0; i < xObstaclesList.length(); i++) {
- QDomElement xPoly = xObstaclesList.item(i).firstChildElement("polygon");
- while(!xPoly.isNull()) {
- //wall thickness, default to 30 cm
- double thickness = xPoly.attribute("thickness","15").toDouble();
- //wall height default to 250 cm
- double height = xPoly.attribute("height","250").toDouble();
- //wall color default to blue
- double color = xPoly.attribute("color","0").toDouble();
-
- QDomNodeList xVertices=xPoly.elementsByTagName("vertex");
- for( int i=0; i<xVertices.count()-1; i++) {
- double x1=xVertices.item(i).toElement().attribute("px", "0").toDouble()*xToCmfactor;
- double y1=xVertices.item(i).toElement().attribute("py", "0").toDouble()*xToCmfactor;
- double z1=xVertices.item(i).toElement().attribute("pz", "0").toDouble()*xToCmfactor;
-
- double x2=xVertices.item(i+1).toElement().attribute("px", "0").toDouble()*xToCmfactor;
- double y2=xVertices.item(i+1).toElement().attribute("py", "0").toDouble()*xToCmfactor;
- double z2=xVertices.item(i+1).toElement().attribute("pz", "0").toDouble()*xToCmfactor;
- geo->addWall(x1, y1, z1, x2, y2,z2,thickness,height,color);
- }
- xPoly = xPoly.nextSiblingElement("polygon");
- }
- }
-
- QDomNodeList xCrossingsList=doc.elementsByTagName("crossing");
-
- for (int i = 0; i < xCrossingsList.length(); i++) {
- QDomElement xCrossing = xCrossingsList.item(i).toElement();
- QDomNodeList xVertices=xCrossing.elementsByTagName("vertex");
-
- ///door thickness, default to 15 cm
- double thickness = xCrossing.attribute("thickness","15").toDouble();
- //door height default to 250 cm
- double height = xCrossing.attribute("height","250").toDouble();
- //door color default to blue
- double color = xCrossing.attribute("color","120").toDouble();
- QString id= xCrossing.attribute("id","-1");
-
- double x1=xVertices.item(0).toElement().attribute("px", "0").toDouble()*xToCmfactor;
- double y1=xVertices.item(0).toElement().attribute("py", "0").toDouble()*xToCmfactor;
- double z1=xVertices.item(0).toElement().attribute("pz", "0").toDouble()*xToCmfactor;
-
- double x2=xVertices.item(1).toElement().attribute("px", "0").toDouble()*xToCmfactor;
- double y2=xVertices.item(1).toElement().attribute("py", "0").toDouble()*xToCmfactor;
- double z2=xVertices.item(1).toElement().attribute("pz", "0").toDouble()*xToCmfactor;
- geo->addNavLine(x1, y1, z1, x2, y2,z2,thickness,height,color);
-
- double center[3]= {(x1+x2)/2.0, (y1+y2)/2.0, (z2+z1)/2.0};
- geo->addObjectLabel(center,center,id.toStdString(),21);
- }
-
- QDomNodeList xTransitionsList=doc.elementsByTagName("transition");
- for (int i = 0; i < xTransitionsList.length(); i++) {
- QDomElement xTransition = xTransitionsList.item(i).toElement();
- QDomNodeList xVertices=xTransition.elementsByTagName("vertex");
-
- ///door thickness, default to 15 cm
- double thickness = xTransition.attribute("thickness","15").toDouble();
- //door height default to 250 cm
- double height = xTransition.attribute("height","250").toDouble();
- //door color default to blue
- double color = xTransition.attribute("color","255").toDouble();
-
- double x1=xVertices.item(0).toElement().attribute("px", "0").toDouble()*xToCmfactor;
- double y1=xVertices.item(0).toElement().attribute("py", "0").toDouble()*xToCmfactor;
- double z1=xVertices.item(0).toElement().attribute("pz", "0").toDouble()*xToCmfactor;
-
- double x2=xVertices.item(1).toElement().attribute("px", "0").toDouble()*xToCmfactor;
- double y2=xVertices.item(1).toElement().attribute("py", "0").toDouble()*xToCmfactor;
- double z2=xVertices.item(1).toElement().attribute("pz", "0").toDouble()*xToCmfactor;
- geo->addDoor(x1, y1, z1, x2, y2,z2,thickness,height,color);
-
- string id= xTransition.attribute("id","-1").toStdString();
- double center[3]= {(x1+x2)/2.0, (y1+y2)/2.0, (z2+z1)/2.0};
- geo->addObjectLabel(center,center,id,21);
- }
-
- //room 0, subroom 0
- geoFac.AddElement(0,0,geo);
+ cout << "parsing 04\n" ;
+ QDomDocument doc("");
+ QFile file(filename);
+
+ int size =file.size()/(1024*1024);
+
+ //avoid dom parsing a very large dataset
+ if(size>500) {
+ //cout<<"The file is too large: "<<filename.toStdString()<<endl;
+ return;
+ }
+
+ auto geo= shared_ptr<FacilityGeometry>(new FacilityGeometry("no name", "no name", "no name"));
+ //cout<<"filename: "<<filename.toStdString()<<endl;
+
+ //TODO: check if you can parse this with the building classes.
+ // This should be a fall back option
+
+ if (!file.open(QIODevice::ReadOnly)) {
+ qDebug()<<"could not open the file: "<<filename<<endl;
+ return ;
+ }
+ QString *errorCode = new QString();
+ if (!doc.setContent(&file, errorCode)) {
+ file.close();
+ qDebug()<<errorCode<<endl;
+ return ;
+ }
+ QDomElement root= doc.documentElement();
+
+ //only parsing the geometry node
+ if(root.tagName()!="geometry") return;
+
+
+ double version =root.attribute("version","-1").toDouble();
+
+ string unit=root.attribute("unit","cm").toStdString();
+ double xToCmfactor=100;
+ if (unit=="cm") xToCmfactor=1;
+ if (unit=="m") xToCmfactor=100;
+
+ if(version<0.4) {
+ QMessageBox::warning(0, QObject::tr("Parsing Error"),
+ QObject::tr("Only geometry version >= 0.4 supported"));
+ }
+
+ //parsing the subrooms
+ QDomNodeList xSubRoomsNodeList=doc.elementsByTagName("subroom");
+ //parsing the walls
+ for ( int i = 0; i < xSubRoomsNodeList.length(); i++) {
+ QDomElement xPoly = xSubRoomsNodeList.item(i).firstChildElement("polygon");
+ double position[3]= {0,0,0};
+ double pos_count=1;
+ double color=0;
+
+ while(!xPoly.isNull()) {
+ //wall thickness, default to 30 cm
+ double thickness = xPoly.attribute("thickness","15").toDouble();
+ //wall height default to 250 cm
+ double height = xPoly.attribute("height","250").toDouble();
+ //wall color default to blue
+ color = xPoly.attribute("color","0").toDouble();
+
+ QDomNodeList xVertices=xPoly.elementsByTagName("vertex");
+ pos_count+=xVertices.count()-1;
+
+ for( int i=0; i<xVertices.count()-1; i++) {
+ //all unit are converted in cm
+ double x1=xVertices.item(i).toElement().attribute("px", "0").toDouble()*xToCmfactor;
+ double y1=xVertices.item(i).toElement().attribute("py", "0").toDouble()*xToCmfactor;
+ double z1=xVertices.item(i).toElement().attribute("pz", "0").toDouble()*xToCmfactor;
+ double x2=xVertices.item(i+1).toElement().attribute("px", "0").toDouble()*xToCmfactor;
+ double y2=xVertices.item(i+1).toElement().attribute("py", "0").toDouble()*xToCmfactor;
+ double z2=xVertices.item(i+1).toElement().attribute("pz", "0").toDouble()*xToCmfactor;
+
+ position[0]+= x1;
+ position[1]+= y1;
+ position[2]+= z1;
+
+ geo->addWall(x1, y1, z1, x2, y2,z2,thickness,height,color);
+ }
+ xPoly = xPoly.nextSiblingElement("polygon");
+ }
+
+ //add the caption
+ string roomCaption = xSubRoomsNodeList.item(i).parentNode().toElement().attribute("caption").toStdString();
+ string subroomCaption=xSubRoomsNodeList.item(i).toElement().attribute("id").toStdString();
+ string caption=roomCaption+" ( " + subroomCaption + " ) ";
+ position[0]/=pos_count;
+ position[1]/=pos_count;
+ position[2]/=pos_count;
+ geo->addObjectLabel(position,position,caption,color);
+ geo->SetRoomCaption(roomCaption);
+ geo->SetSubRoomCaption(subroomCaption);
+ cout<<"position: [" <<position[0]<<", "<<position[1]<<", "<<position[2]<<" ]"<<endl;;
+ cout << roomCaption<< " " << subroomCaption << "\n" ;
+ }
+
+ QDomNodeList xObstaclesList=doc.elementsByTagName("obstacle");
+ for ( int i = 0; i < xObstaclesList.length(); i++) {
+ QDomElement xPoly = xObstaclesList.item(i).firstChildElement("polygon");
+ while(!xPoly.isNull()) {
+ //wall thickness, default to 30 cm
+ double thickness = xPoly.attribute("thickness","15").toDouble();
+ //wall height default to 250 cm
+ double height = xPoly.attribute("height","250").toDouble();
+ //wall color default to blue
+ double color = xPoly.attribute("color","0").toDouble();
+
+ QDomNodeList xVertices=xPoly.elementsByTagName("vertex");
+ for( int i=0; i<xVertices.count()-1; i++) {
+ double x1=xVertices.item(i).toElement().attribute("px", "0").toDouble()*xToCmfactor;
+ double y1=xVertices.item(i).toElement().attribute("py", "0").toDouble()*xToCmfactor;
+ double z1=xVertices.item(i).toElement().attribute("pz", "0").toDouble()*xToCmfactor;
+
+ double x2=xVertices.item(i+1).toElement().attribute("px", "0").toDouble()*xToCmfactor;
+ double y2=xVertices.item(i+1).toElement().attribute("py", "0").toDouble()*xToCmfactor;
+ double z2=xVertices.item(i+1).toElement().attribute("pz", "0").toDouble()*xToCmfactor;
+ geo->addWall(x1, y1, z1, x2, y2,z2,thickness,height,color);
+ }
+ xPoly = xPoly.nextSiblingElement("polygon");
+ }
+ }
+
+ QDomNodeList xCrossingsList=doc.elementsByTagName("crossing");
+
+ for (int i = 0; i < xCrossingsList.length(); i++) {
+ QDomElement xCrossing = xCrossingsList.item(i).toElement();
+ QDomNodeList xVertices=xCrossing.elementsByTagName("vertex");
+
+ ///door thickness, default to 15 cm
+ double thickness = xCrossing.attribute("thickness","15").toDouble();
+ //door height default to 250 cm
+ double height = xCrossing.attribute("height","250").toDouble();
+ //door color default to blue
+ double color = xCrossing.attribute("color","120").toDouble();
+ QString id= xCrossing.attribute("id","-1");
+
+ double x1=xVertices.item(0).toElement().attribute("px", "0").toDouble()*xToCmfactor;
+ double y1=xVertices.item(0).toElement().attribute("py", "0").toDouble()*xToCmfactor;
+ double z1=xVertices.item(0).toElement().attribute("pz", "0").toDouble()*xToCmfactor;
+
+ double x2=xVertices.item(1).toElement().attribute("px", "0").toDouble()*xToCmfactor;
+ double y2=xVertices.item(1).toElement().attribute("py", "0").toDouble()*xToCmfactor;
+ double z2=xVertices.item(1).toElement().attribute("pz", "0").toDouble()*xToCmfactor;
+ geo->addNavLine(x1, y1, z1, x2, y2,z2,thickness,height,color);
+
+ double center[3]= {(x1+x2)/2.0, (y1+y2)/2.0, (z2+z1)/2.0};
+ geo->addObjectLabel(center,center,id.toStdString(),21);
+ }
+
+ QDomNodeList xTransitionsList=doc.elementsByTagName("transition");
+ for (int i = 0; i < xTransitionsList.length(); i++) {
+ QDomElement xTransition = xTransitionsList.item(i).toElement();
+ QDomNodeList xVertices=xTransition.elementsByTagName("vertex");
+
+ ///door thickness, default to 15 cm
+ double thickness = xTransition.attribute("thickness","15").toDouble();
+ //door height default to 250 cm
+ double height = xTransition.attribute("height","250").toDouble();
+ //door color default to blue
+ double color = xTransition.attribute("color","255").toDouble();
+
+ double x1=xVertices.item(0).toElement().attribute("px", "0").toDouble()*xToCmfactor;
+ double y1=xVertices.item(0).toElement().attribute("py", "0").toDouble()*xToCmfactor;
+ double z1=xVertices.item(0).toElement().attribute("pz", "0").toDouble()*xToCmfactor;
+
+ double x2=xVertices.item(1).toElement().attribute("px", "0").toDouble()*xToCmfactor;
+ double y2=xVertices.item(1).toElement().attribute("py", "0").toDouble()*xToCmfactor;
+ double z2=xVertices.item(1).toElement().attribute("pz", "0").toDouble()*xToCmfactor;
+ geo->addDoor(x1, y1, z1, x2, y2,z2,thickness,height,color);
+
+ string id= xTransition.attribute("id","-1").toStdString();
+ double center[3]= {(x1+x2)/2.0, (y1+y2)/2.0, (z2+z1)/2.0};
+ geo->addObjectLabel(center,center,id,21);
+ }
+
+ //room 0, subroom 0
+ geoFac.AddElement(0,0,geo);
}
bool SaxParser::ParseTxtFormat(const QString &fileName, SyncData* dataset, double * fps)
{
- //fileName="data/trajectories/1000_1_0_0_1_1.txt";
- //fileName="data/trajectories/50_3_0_1_1_2.txt";
- qDebug()<<"parsing the text file: "<<fileName<<endl;
- QFile inputFile(fileName);
- if (inputFile.open(QIODevice::ReadOnly))
- {
- QTextStream in(&inputFile);
- int lastFrameID=-1;
-
-
- //skip the first line
- in.readLine();
- //the second line contains the framerate
- QString line = in.readLine();
- if(line.split(":").size()==2)
- {
- bool ok;
- *fps=line.split(":")[1].toDouble(&ok);
- if(!ok) *fps=16;//default value
- qDebug()<<"frame rate: "<<*fps<<endl; //exit(0);
- }
-
- line = in.readLine();
- int maxFrame=1000;
- if(line.split(":").size()==2)
- {
- bool ok;
- maxFrame=line.split(":")[1].toDouble(&ok);
- if(!ok) maxFrame=1000;//default value
- //cout<<"frame: "<<maxFrame<<endl; exit(0);
- }
-
- //initialize the process dialog
- QProgressDialog progressDialog ("Simulation","Abbrechen",1, maxFrame,NULL);
- progressDialog.setModal(true);
- //_progressDialog->setStyleSheet(stylesheet);
- progressDialog.setWindowFlags(Qt::FramelessWindowHint|Qt::WindowStaysOnTopHint);
- //_progressDialog->setWindowFlags(Qt::Dialog | Qt::FramelessWindowHint | Qt::WindowTitleHint|Qt::WindowStaysOnTopHint);
- progressDialog.setFixedSize(400,100);
- progressDialog.setLabelText("<h3>Loading...</h3>");
- QList<QPushButton *> buttons=progressDialog.findChildren<QPushButton *>();
- buttons.at(0)->hide(); // that is the cancel button
- progressDialog.setValue(1);
- progressDialog.show();
-
- double unitFactor=1;// I assume meter
-
- while ( !in.atEnd() )
- {
- QString line = in.readLine();
- QStringList pieces = line.split(QRegExp("\\s"));
-
- double pos[3];
- double angle[3]={0,0,30};
- double radius[3]={0.3,0.3,0.3};
-
- int agentID=-1 ;
- int frameID=-1;
- double color=155 ;
-
- switch(pieces.size())
- {
- case 5:
- agentID=pieces[0].toInt();
- frameID=pieces[1].toInt();
- pos[0]=pieces[2].toDouble()*unitFactor;
- pos[1]=pieces[3].toDouble()*unitFactor;
- pos[2]=pieces[4].toDouble()*unitFactor;
- break;
-
- case 9:
- agentID=pieces[0].toInt();
- frameID=pieces[1].toInt();
- color=pieces[8].toDouble();
- pos[0]=pieces[2].toDouble()*unitFactor;
- pos[1]=pieces[3].toDouble()*unitFactor;
- pos[2]=pieces[4].toDouble()*unitFactor;
- radius[0]=pieces[5].toDouble()*unitFactor;
- radius[1]=pieces[6].toDouble()*unitFactor;
- angle[2]=pieces[7].toDouble();
- break;
-
- default:
- //try to scan the line for the unit
- if(line.contains("centimeter", Qt::CaseInsensitive)||
- line.contains("centimetre", Qt::CaseInsensitive))
- {
- unitFactor=0.01;
- qDebug()<<"unit centimetre detected";
- }
- else
- if(line.contains("meter", Qt::CaseInsensitive)||
- line.contains("metre", Qt::CaseInsensitive))
+ //fileName="data/trajectories/1000_1_0_0_1_1.txt";
+ //fileName="data/trajectories/50_3_0_1_1_2.txt";
+ qDebug()<<"parsing the text file: "<<fileName<<endl;
+ QFile inputFile(fileName);
+ if (inputFile.open(QIODevice::ReadOnly))
+ {
+ QTextStream in(&inputFile);
+ int lastFrameID=-1;
+
+
+ //skip the first line
+ in.readLine();
+ //the second line contains the framerate
+ QString line = in.readLine();
+ if(line.split(":").size()==2)
+ {
+ bool ok;
+ *fps=line.split(":")[1].toDouble(&ok);
+ if(!ok) *fps=16;//default value
+ qDebug()<<"frame rate: "<<*fps<<endl; //exit(0);
+ }
+
+ line = in.readLine();
+ int maxFrame=1000;
+ if(line.split(":").size()==2)
+ {
+ bool ok;
+ maxFrame=line.split(":")[1].toDouble(&ok);
+ if(!ok) maxFrame=1000;//default value
+ //cout<<"frame: "<<maxFrame<<endl; exit(0);
+ }
+
+ //initialize the process dialog
+ QProgressDialog progressDialog ("Simulation","Abbrechen",1, maxFrame,NULL);
+ progressDialog.setModal(true);
+ //_progressDialog->setStyleSheet(stylesheet);
+ progressDialog.setWindowFlags(Qt::FramelessWindowHint|Qt::WindowStaysOnTopHint);
+ //_progressDialog->setWindowFlags(Qt::Dialog | Qt::FramelessWindowHint | Qt::WindowTitleHint|Qt::WindowStaysOnTopHint);
+ progressDialog.setFixedSize(400,100);
+ progressDialog.setLabelText("<h3>Loading...</h3>");
+ QList<QPushButton *> buttons=progressDialog.findChildren<QPushButton *>();
+ buttons.at(0)->hide(); // that is the cancel button
+ progressDialog.setValue(1);
+ progressDialog.show();
+
+ double unitFactor=1;// I assume meter
+
+ while ( !in.atEnd() )
+ {
+ QString line = in.readLine();
+ QStringList pieces = line.split(QRegExp("\\s"));
+
+ double pos[3];
+ double angle[3]={0,0,30};
+ double radius[3]={0.3,0.3,0.3};
+
+ int agentID=-1 ;
+ int frameID=-1;
+ double color=155 ;
+
+ switch(pieces.size())
+ {
+ case 5:
+ agentID=pieces[0].toInt();
+ frameID=pieces[1].toInt();
+ pos[0]=pieces[2].toDouble()*unitFactor;
+ pos[1]=pieces[3].toDouble()*unitFactor;
+ pos[2]=pieces[4].toDouble()*unitFactor;
+ break;
+
+ case 9:
+ agentID=pieces[0].toInt();
+ frameID=pieces[1].toInt();
+ color=pieces[8].toDouble();
+ pos[0]=pieces[2].toDouble()*unitFactor;
+ pos[1]=pieces[3].toDouble()*unitFactor;
+ pos[2]=pieces[4].toDouble()*unitFactor;
+ radius[0]=pieces[5].toDouble()*unitFactor;
+ radius[1]=pieces[6].toDouble()*unitFactor;
+ angle[2]=pieces[7].toDouble();
+ break;
+
+ default:
+ //try to scan the line for the unit
+ if(line.contains("centimeter", Qt::CaseInsensitive)||
+ line.contains("centimetre", Qt::CaseInsensitive))
{
- unitFactor=1;
- qDebug()<<"unit metre detected";
+ unitFactor=0.01;
+ qDebug()<<"unit centimetre detected";
}
else
- {
- qDebug()<<"Ignoring line: "<<line;
- }
- continue;//next line
- break;
- }
-
- FrameElement *element = new FrameElement(agentID-1);
- element->SetPos(pos);
- element->SetOrientation(angle);
- element->SetRadius(radius);
- element->SetColor(color);
-
- if(dataset->GetFrames().count(frameID)<1)
- {
- Frame* frame = new Frame(frameID);
- frame->addElement(element);
- dataset->addFrame(frame);
- //cout<<"adding frame: "<<frameID<<endl;
- }
- else
- {
- dataset->GetFrames()[frameID]->addElement(element);
- }
-
- //a new frame is starting.
- // not longer necessary if you are using maps and frameid
- if(frameID!=lastFrameID)
- {
- progressDialog.setValue(dataset->getSize());
- lastFrameID=frameID;
- QCoreApplication::processEvents(QEventLoop::ExcludeUserInputEvents);
- }
- }
-
- inputFile.close();
- qDebug()<<dataset->GetFrames().size()<<" frames added";
- //construct the polydata
- for( const auto & frame:dataset->GetFrames())
- {
- frame.second->ComputePolyData();
- //cout<<"computing polydata"<<endl;
- }
- //dataset->setNumberOfAgents(50);
-
- }
- else
- {
- qDebug()<<"could not open the file: "<<fileName<<endl;
- return false;
- }
-
- return true;
+ if(line.contains("meter", Qt::CaseInsensitive)||
+ line.contains("metre", Qt::CaseInsensitive))
+ {
+ unitFactor=1;
+ qDebug()<<"unit metre detected";
+ }
+ else
+ {
+ qDebug()<<"Ignoring line: "<<line;
+ }
+ continue;//next line
+ break;
+ }
+
+ FrameElement *element = new FrameElement(agentID-1);
+ element->SetPos(pos);
+ element->SetOrientation(angle);
+ element->SetRadius(radius);
+ element->SetColor(color);
+
+ if(dataset->GetFrames().count(frameID)<1)
+ {
+ Frame* frame = new Frame(frameID);
+ frame->addElement(element);
+ dataset->addFrame(frame);
+ //cout<<"adding frame: "<<frameID<<endl;
+ }
+ else
+ {
+ dataset->GetFrames()[frameID]->addElement(element);
+ }
+
+ //a new frame is starting.
+ // not longer necessary if you are using maps and frameid
+ if(frameID!=lastFrameID)
+ {
+ progressDialog.setValue(dataset->getSize());
+ lastFrameID=frameID;
+ QCoreApplication::processEvents(QEventLoop::ExcludeUserInputEvents);
+ }
+ }
+
+ inputFile.close();
+ qDebug()<<dataset->GetFrames().size()<<" frames added";
+ //construct the polydata
+ for( const auto & frame:dataset->GetFrames())
+ {
+ frame.second->ComputePolyData();
+ //cout<<"computing polydata"<<endl;
+ }
+ //dataset->setNumberOfAgents(50);
+
+ }
+ else
+ {
+ qDebug()<<"could not open the file: "<<fileName<<endl;
+ return false;
+ }
+
+ return true;
}
bool SaxParser::ParseGradientFieldVTK(QString fileName, GeometryFactory& geoFac)
{
- if(QFileInfo(fileName).isRelative())
- {
- QString wd;
- SystemSettings::getWorkingDirectory(wd);
- fileName=wd+"/"+fileName;
- }
-
- qDebug()<<"Opening the gradient field:"<<fileName<<endl;
- // Read the file
- VTK_CREATE(vtkStructuredPointsReader, reader);
- reader->SetFileName(fileName.toStdString().c_str());
- reader->Update();
- reader->SetLookupTableName("LOOKUP_TABLE default");
-
- VTK_CREATE(vtkImageDataGeometryFilter,geometryFilter );
- geometryFilter->SetInputConnection(reader->GetOutputPort());
- geometryFilter->Update();
-
- //try a triangle strip
+ if(QFileInfo(fileName).isRelative())
+ {
+ QString wd;
+ SystemSettings::getWorkingDirectory(wd);
+ fileName=wd+"/"+fileName;
+ }
+
+ qDebug()<<"Opening the gradient field:"<<fileName<<endl;
+ // Read the file
+ VTK_CREATE(vtkStructuredPointsReader, reader);
+ reader->SetFileName(fileName.toStdString().c_str());
+ reader->Update();
+ reader->SetLookupTableName("LOOKUP_TABLE default");
+
+ VTK_CREATE(vtkImageDataGeometryFilter,geometryFilter );
+ geometryFilter->SetInputConnection(reader->GetOutputPort());
+ geometryFilter->Update();
+
+ //try a triangle strip
// VTK_CREATE(vtkStripper,stripper);
// stripper->SetInputConnection(geometryFilter->GetOutputPort());
// VTK_CREATE(vtkTriangleFilter,trianglefilter);
// trianglefilter->SetInputConnection(stripper->GetOutputPort());
- VTK_CREATE(vtkPolyDataMapper,mapper);
- mapper->SetInputConnection(geometryFilter->GetOutputPort());
+ VTK_CREATE(vtkPolyDataMapper,mapper);
+ mapper->SetInputConnection(geometryFilter->GetOutputPort());
- VTK_CREATE(vtkActor, actor);
- actor->SetMapper(mapper);
- //conversion from m to cm
- actor->SetScale(100);
+ VTK_CREATE(vtkActor, actor);
+ actor->SetMapper(mapper);
+ //conversion from m to cm
+ actor->SetScale(100);
- auto gradient_field= shared_ptr<FacilityGeometry>(new FacilityGeometry("Gradient Field", "no name", "no name"));
- gradient_field->addGradientField(actor);
+ auto gradient_field= shared_ptr<FacilityGeometry>(new FacilityGeometry("Gradient Field", "no name", "no name"));
+ gradient_field->addGradientField(actor);
- geoFac.AddElement(-1,-1,gradient_field);
- geoFac.AddElement(-2,-2,gradient_field);
- return true;
+ geoFac.AddElement(-1,-1,gradient_field);
+ geoFac.AddElement(-2,-2,gradient_field);
+ return true;
}
void SaxParser::InitHeader(int major, int minor, int patch)
{
- if ( (minor==6) || (minor==5 && patch==1) ) {
- _jps_xPos=QString("x");
- _jps_yPos=QString("y");
- _jps_zPos=QString("z");
- _jps_xVel=QString("xV");
- _jps_yVel=QString("yV");
- _jps_zVel=QString("zV");
- _jps_radiusA=QString("rA");
- _jps_radiusB=QString("rB");
- _jps_ellipseOrientation=QString("eO");
- _jps_ellipseColor=QString("eC");
- } else {
- _jps_xPos=QString("xPos");
- _jps_yPos=QString("yPos");
- _jps_zPos=QString("zPos");
- _jps_xVel=QString("xVel");
- _jps_yVel=QString("yVel");
- _jps_zVel=QString("zVel");
- _jps_radiusA=QString("radiusA");
- _jps_radiusB=QString("radiusB");
- _jps_ellipseOrientation=QString("ellipseOrientation");
- _jps_ellipseColor=QString("ellipseColor");
- }
- if(major!=0) {
- cout<<"unsupported header version: "<<major<<"."<<minor<<"."<<patch<<endl;
- cout<<"Please use 0.5 0.5.1 or 0.6 "<<endl;
- exit(0);
- }
+ if ( (minor==6) || (minor==5 && patch==1) ) {
+ _jps_xPos=QString("x");
+ _jps_yPos=QString("y");
+ _jps_zPos=QString("z");
+ _jps_xVel=QString("xV");
+ _jps_yVel=QString("yV");
+ _jps_zVel=QString("zV");
+ _jps_radiusA=QString("rA");
+ _jps_radiusB=QString("rB");
+ _jps_ellipseOrientation=QString("eO");
+ _jps_ellipseColor=QString("eC");
+ } else {
+ _jps_xPos=QString("xPos");
+ _jps_yPos=QString("yPos");
+ _jps_zPos=QString("zPos");
+ _jps_xVel=QString("xVel");
+ _jps_yVel=QString("yVel");
+ _jps_zVel=QString("zVel");
+ _jps_radiusA=QString("radiusA");
+ _jps_radiusB=QString("radiusB");
+ _jps_ellipseOrientation=QString("ellipseOrientation");
+ _jps_ellipseColor=QString("ellipseColor");
+ }
+ if(major!=0) {
+ cout<<"unsupported header version: "<<major<<"."<<minor<<"."<<patch<<endl;
+ cout<<"Please use 0.5 0.5.1 or 0.6 "<<endl;
+ exit(0);
+ }
}
--
GitLab