|
@@ -10,7 +10,7 @@
|
|
|
static int gnLineIndex = 0;
|
|
|
|
|
|
|
|
|
-void DrawLine(std::vector<iv::LanePoint> & xveclastlp,std::vector<iv::LanePoint> & xveclp,pcl::visualization::PCLVisualizer& viewer, double fz)
|
|
|
+void DrawLine(std::vector<iv::LanePoint> & xveclastlp,std::vector<iv::LanePoint> & xveclp,pcl::visualization::PCLVisualizer& viewer, double fz,int nmode)
|
|
|
{
|
|
|
|
|
|
|
|
@@ -41,7 +41,7 @@ void DrawLine(std::vector<iv::LanePoint> & xveclastlp,std::vector<iv::LanePoint>
|
|
|
}
|
|
|
}
|
|
|
|
|
|
-void ShowRoad(pcl::visualization::PCLVisualizer& viewer,Road * pRoad,double fz)
|
|
|
+void ShowRoad(pcl::visualization::PCLVisualizer& viewer,Road * pRoad,double fz,int nmode)
|
|
|
{
|
|
|
|
|
|
if(pRoad->GetLaneSectionCount()<1)
|
|
@@ -79,7 +79,7 @@ void ShowRoad(pcl::visualization::PCLVisualizer& viewer,Road * pRoad,double fz)
|
|
|
{
|
|
|
|
|
|
//Draw Line
|
|
|
- DrawLine(xveclastlp,xveclp,viewer,fz);
|
|
|
+ DrawLine(xveclastlp,xveclp,viewer,fz,nmode);
|
|
|
xveclastlp = xveclp;
|
|
|
flasthdg = fhdg;
|
|
|
flastS = s;
|
|
@@ -92,7 +92,7 @@ void ShowRoad(pcl::visualization::PCLVisualizer& viewer,Road * pRoad,double fz)
|
|
|
{
|
|
|
pRoad->GetGeometryCoords(fRoadLen,x,y,fhdg);
|
|
|
xveclp = xodrfunc::GetAllLanePoint(pRoad,s,x,y,fhdg);
|
|
|
- DrawLine(xveclastlp,xveclp,viewer,fz);
|
|
|
+ DrawLine(xveclastlp,xveclp,viewer,fz,nmode);
|
|
|
}
|
|
|
|
|
|
|
|
@@ -100,7 +100,7 @@ void ShowRoad(pcl::visualization::PCLVisualizer& viewer,Road * pRoad,double fz)
|
|
|
|
|
|
}
|
|
|
|
|
|
-void ShowXODRINVTK(pcl::visualization::PCLVisualizer& viewer,double & flon,double & flat,bool & bxodr,double fz)
|
|
|
+void ShowXODRINVTK(pcl::visualization::PCLVisualizer& viewer,double & flon,double & flat,bool & bxodr,double fz,int nmode)
|
|
|
{
|
|
|
|
|
|
char strpath[256];
|
|
@@ -119,7 +119,7 @@ void ShowXODRINVTK(pcl::visualization::PCLVisualizer& viewer,double & flon,doubl
|
|
|
unsigned int i;
|
|
|
for(i=0;i<xxodr.GetRoadCount();i++)
|
|
|
{
|
|
|
- ShowRoad(viewer,xxodr.GetRoad(i),fz);
|
|
|
+ ShowRoad(viewer,xxodr.GetRoad(i),fz,nmode);
|
|
|
}
|
|
|
|
|
|
|