rviz中marker显示

General 5219

已于 2024-08-10 19:26:01 修改

阅读量882

点赞数 1

文章标签：机器人

于 2022-11-01 21:48:26 首次发布

本文链接：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();
  }
}