ROS_PCL+Rviz创建点云并三维显示

最新推荐文章于 2025-06-25 22:46:03 发布

光子乘羽

最新推荐文章于 2025-06-25 22:46:03 发布

阅读量9.3k

点赞数 3

CC 4.0 BY-SA版权

分类专栏： PCL ROS

本文链接：https://blog.youkuaiyun.com/hanshuning/article/details/52346189

ROS 同时被 2 个专栏收录

41 篇文章

订阅专栏

PCL

9 篇文章

订阅专栏

本文介绍了一个使用PCL库创建并发布点云数据到ROS系统的简单程序实例。该程序生成了一个包含100个随机分布点的点云，并将其转换为ROS消息格式发布到指定主题上。通过RViz可视化工具可以实时查看这些点云数据。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

1.程序包的配置等参照第一个PCL程序

2.代码.cpp

#include<ros/ros.h>
#include<pcl/point_cloud.h>
#include<pcl_conversions/pcl_conversions.h>
#include<sensor_msgs/PointCloud2.h>

main (int argc, char **argv)
{
  ros::init (argc, argv, "pcl_create");
  ros::NodeHandle nh;
  ros::Publisher pcl_pub = nh.advertise<sensor_msgs::PointCloud2> ("pcl_output", 1);
  pcl::PointCloud<pcl::PointXYZ> cloud;
  sensor_msgs::PointCloud2 output;
  // Fill in the cloud data
  cloud.width = 100;
  cloud.height = 1;
  cloud.points.resize(cloud.width * cloud.height);
  for (size_t i = 0; i < cloud.points.size(); ++i)
  {
    cloud.points[i].x = 1024 * rand () / (RAND_MAX + 1.0f);
    cloud.points[i].y = 1024 * rand () / (RAND_MAX + 1.0f);
    cloud.points[i].z = 1024 * rand () / (RAND_MAX + 1.0f);
  }

  //Convert the cloud to ROS message
  pcl::toROSMsg(cloud, output);
  output.header.frame_id = "odom";//this has been done in order to be able to visualize our PointCloud2 message on the RViz visualizer
  ros::Rate loop_rate(1);
  while (ros::ok())
  {
    pcl_pub.publish(output);
    ros::spinOnce();
    loop_rate.sleep();
  }
  return 0;
}

3.编译

cd catkin_ws

source devel/setup.bash

catkin_make

4.运行

roscore

rosrun imgpcl pcl_create

rosrun rviz rviz

5.Rviz的配置

点击Add,添加pointcloud2,

Fixed Frame设置为odom.

Topic 设置为/pcl_output