diff --git a/src/opendrive_link.cpp b/src/opendrive_link.cpp index bb112cbd4d045711e89b34e9d77cb3738cb2e540..021d9042c0367e2dc9e074d8fbea8a8d1cd4fb1f 100644 --- a/src/opendrive_link.cpp +++ b/src/opendrive_link.cpp @@ -113,32 +113,8 @@ void COpendriveLink::operator=(const COpendriveLink &object) std::ostream& operator<<(std::ostream& out, COpendriveLink &link) { - TOpendriveTrackPoint end_point_track; - TOpendriveWorldPoint end_point_world; - - for(unsigned int i=0;i<link.get_prev().get_num_lanes();i++) - { - if(link.get_prev().lanes[i]->get_id()<0) - { - end_point_track.t=link.get_prev().lanes[i]->get_offset()-link.get_prev().lanes[i]->get_width()/2.0; - end_point_track.s=link.get_prev().geometries[i]->get_length(); - } - else - { - end_point_track.t=link.get_prev().lanes[i]->get_offset()+link.get_prev().lanes[i]->get_width()/2.0; - end_point_track.s=0.0; - } - end_point_track.heading=0.0; - link.get_prev().geometries[i]->get_world_pose(end_point_track,end_point_world); - for(unsigned int j=0;j<link.get_next().get_num_lanes();j++) - { - if(link.get_prev().lanes[i]->get_segment().get_parent_road().get_node_at(end_point_world)==link.next) - { - out << " Previous node: " << link.get_prev().get_index(i) << " of lane " << link.get_prev().get_lane(i).get_id() << " of road " << link.get_prev().get_lane(i).get_segment().get_name() << std::endl; - out << " Next node: " << link.get_next().get_index(j) << " of lane " << link.get_next().get_lane(j).get_id() << " of road " << link.get_next().get_lane(j).get_segment().get_name() << std::endl; - } - } - } + out << " Previous node: " << link.get_prev().get_index() << " of road " << link.get_prev().get_parent_segment().get_name() << std::endl; + out << " Next node: " << link.get_next().get_index() << " of road " << link.get_next().get_parent_segment().get_name() << std::endl; out << " Road mark: "; switch(link.mark) {