Merge pull request #124 from uzh-rpg/feature/use_camera_marker
use pyramid camera marker for visualization
This commit is contained in:
@@ -211,9 +211,9 @@ void Visualizer::visualizeMarkers(
|
|||||||
|
|
||||||
if(pub_frames_.getNumSubscribers() > 0 || pub_points_.getNumSubscribers() > 0)
|
if(pub_frames_.getNumSubscribers() > 0 || pub_points_.getNumSubscribers() > 0)
|
||||||
{
|
{
|
||||||
vk::output_helper::publishHexacopterMarker(
|
vk::output_helper::publishCameraMarker(
|
||||||
pub_frames_, "cam_pos", "cams", ros::Time(frame->timestamp_),
|
pub_frames_, "cam_pos", "cams", ros::Time(frame->timestamp_),
|
||||||
1, 0, 0.3, Vector3d(0.,0.,1.));
|
1, 0.3, Vector3d(0.,0.,1.));
|
||||||
vk::output_helper::publishPointMarker(
|
vk::output_helper::publishPointMarker(
|
||||||
pub_points_, T_world_from_vision_*frame->pos(), "trajectory",
|
pub_points_, T_world_from_vision_*frame->pos(), "trajectory",
|
||||||
ros::Time::now(), trace_id_, 0, 0.006, Vector3d(0.,0.,0.5));
|
ros::Time::now(), trace_id_, 0, 0.006, Vector3d(0.,0.,0.5));
|
||||||
|
|||||||
Reference in New Issue
Block a user