Skip to content
Snippets Groups Projects
Commit 39e06beb authored by Sergi Hernandez's avatar Sergi Hernandez
Browse files

Changed the stream output.

parent e8bdb4df
No related branches found
No related tags found
No related merge requests found
......@@ -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)
{
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment