Solved a bug when updating the start and end poses of a lane: the new node...

Solved a bug when updating the start and end poses of a lane: the new node data is updated instead of the original one.

src/opendrive_lane.cpp

@@ -425,13 +425,15 @@ void COpendriveLane::update_start_node(node_up_ref_t &new_node_ref,lane_up_ref_t
       {
         new_node=(*it)->clone(new_link_ref);
         new_node_ref[*it]=new_node;
+        if(i==start_node_index)
+          new_node->update_start_pose(start_pose,new_node_ref,distance);
       }
       it++;
     }
   }
   this->prev.clear();// it is no longer connected to any previous lane
 //  this->update_references(new_segment_ref,new_lane_ref,new_node_ref);
-  this->nodes[0]->update_start_pose(this,start_pose,distance);
+//  this->nodes[0]->update_start_pose(this,start_pose,distance);
 }
 
 void COpendriveLane::update_end_node(node_up_ref_t &new_node_ref,lane_up_ref_t &new_lane_ref,link_up_ref_t &new_link_ref,TOpendriveWorldPose *end)
@@ -471,13 +473,15 @@ void COpendriveLane::update_end_node(node_up_ref_t &new_node_ref,lane_up_ref_t &
       {
         new_node=(*it)->clone(new_link_ref);
         new_node_ref[*it]=new_node;
+        if(i==end_node_index)
+          new_node->update_end_pose(end_pose,new_node_ref);
       }
       it++;
     }
   }
   this->next.clear();// it is no longer connected to any next lane
 //  this->update_references(new_segment_ref,new_lane_ref,new_node_ref);
-  this->nodes[this->nodes.size()-1]->update_end_pose(this,end_pose,distance);
+//  this->nodes[this->nodes.size()-1]->update_end_pose(this,end_pose,distance);
 }
 
 COpendriveLane *COpendriveLane::get_sub_lane(node_up_ref_t &new_node_ref,lane_up_ref_t &new_lane_ref,link_up_ref_t &new_link_ref,TOpendriveWorldPose *start,TOpendriveWorldPose *end)