fixes in viz

mpkuse · mpkuse · commit 9950b2f26c2a · 2019-06-10T16:51:07.000+08:00
diff --git a/src/keyframe_pose_graph_slam_node.cpp b/src/keyframe_pose_graph_slam_node.cpp
@@ -1223,7 +1223,7 @@ void opt_traj_publisher_colored_by_world( const NodeDataManager * manager, const
                     // once in a while flush the unused co-ordinates
                     Matrix4d _axis_pose = Matrix4d::Identity();
                     for( int p=setids_to_udumbes.size() ; p<20;  p++ ) {
-                        viz->publishXYZAxis( _axis_pose, "opt_traj_axis", 0, 0.0  );
+                        viz->publishXYZAxis( _axis_pose, "opt_traj_axis", p, 0.0  );
                     }
                 }
 

Original file line number	Diff line number	Diff line change
`@@ -1223,7 +1223,7 @@ void opt_traj_publisher_colored_by_world( const NodeDataManager * manager, const`
`1223`	`1223`	`// once in a while flush the unused co-ordinates`
`1224`	`1224`	`Matrix4d _axis_pose = Matrix4d::Identity();`
`1225`	`1225`	`for( int p=setids_to_udumbes.size() ; p<20; p++ ) {`
`1226`		`- viz->publishXYZAxis( _axis_pose, "opt_traj_axis", 0, 0.0 );`
	`1226`	`+ viz->publishXYZAxis( _axis_pose, "opt_traj_axis", p, 0.0 );`
`1227`	`1227`	`}`
`1228`	`1228`	`}`
`1229`	`1229`