rviz中marker显示

最新推荐文章于 2024-04-11 14:59:09 发布

General 5219

最新推荐文章于 2024-04-11 14:59:09 发布

阅读量765

点赞数 1

文章标签：机器人

本文链接：https://blog.csdn.net/m0_43422224/article/details/127641983

版权

rviz中marker显示

最近想对激光雷达数据做一些处理，其中必然少不了可视化部分，可以帮助我们看到每一步的效果。marker提供了一个很好的工具，今天折腾了一下marker中point的使用:
问题：配置points基本信息后报错如下：

在这里插入图片描述

    visualization_msgs::Marker points;
    points.header.frame_id  = "/my_frame";
    points.header.stamp = ros::Time::now();
    points.ns =  "points";
    points.action = visualization_msgs::Marker::ADD;
    points.pose.orientation.w  = 1.0;
 
    points.id = 0;
 
    points.type = visualization_msgs::Marker::POINTS;
 
    points.scale.x = 0.2;
    points.scale.y = 0.2;

    points.color.g = 1.0f;
    points.color.a = 1.0;

参考代码，发现在配置完成后需要给定points坐标，不给定的花就会出现如商报错信息，结合参考代码，修改后的代码如下：

#include <ros/ros.h>
#include <visualization_msgs/Marker.h>
 
int main( int argc, char** argv )
{
  ros::init(argc, argv, "points_marker");
  ros::NodeHandle n;
  ros::Publisher marker_pub = n.advertise<visualization_msgs::Marker>("point_marker", 10);
 
  ros::Rate r(30);
 
  float f = 0.0;
  while (ros::ok())
  {
    visualization_msgs::Marker points;
    points.header.frame_id  = "/my_frame";
    points.header.stamp = ros::Time::now();
    points.ns =  "points";
    points.action = visualization_msgs::Marker::ADD;
    points.pose.orientation.w  = 1.0;
 
    points.id = 0;
 
    points.type = visualization_msgs::Marker::POINTS;
    points.scale.x = 0.2;
    points.scale.y = 0.2;

    points.color.g = 1.0f;
    points.color.a = 1.0;
    
    geometry_msgs::Point p;
    p.x = 0;
    p.y = 0;
    p.z = 0;
    points.points.push_back(p);

    marker_pub.publish(points); 
    r.sleep();
  }
}