|
@@ -1404,13 +1404,13 @@ std::vector<PlanPoint> GetPoint(pathsection xpath,const double fspace = 0.1)
|
|
{
|
|
{
|
|
PlanPoint pp = xvectorPP.at(j);
|
|
PlanPoint pp = xvectorPP.at(j);
|
|
|
|
|
|
- double foffset = pRoad->GetLaneOffsetValue(pp.mS);
|
|
|
|
|
|
+// double foffset = pRoad->GetLaneOffsetValue(pp.mS);
|
|
|
|
|
|
- if(fabs(foffset)>0.001)
|
|
|
|
- {
|
|
|
|
- pp.x = pp.x + foffset * cos(pp.hdg + M_PI/2.0);
|
|
|
|
- pp.y = pp.y + foffset * sin(pp.hdg + M_PI/2.0);
|
|
|
|
- }
|
|
|
|
|
|
+// if(fabs(foffset)>0.001)
|
|
|
|
+// {
|
|
|
|
+// pp.x = pp.x + foffset * cos(pp.hdg + M_PI/2.0);
|
|
|
|
+// pp.y = pp.y + foffset * sin(pp.hdg + M_PI/2.0);
|
|
|
|
+// }
|
|
|
|
|
|
pp.mfCurvature = pRoad->GetRoadCurvature(pp.mS);
|
|
pp.mfCurvature = pRoad->GetRoadCurvature(pp.mS);
|
|
|
|
|