（八）ROS创建点云数据并在rviz中显示

最新推荐文章于 2023-10-31 11:48:02 发布

火星机器人life

最新推荐文章于 2023-10-31 11:48:02 发布

阅读量1.9w

点赞数 7

分类专栏： ROS SLAM基础工具及算法文章标签：函数数据机器人源码

本文链接：https://blog.csdn.net/ktigerhero3/article/details/70185651

版权

ROS 同时被 2 个专栏收录

28 篇文章 44 订阅

订阅专栏

SLAM基础工具及算法

20 篇文章 42 订阅

订阅专栏

示例选自ROS机器人程序设计（原书第2版）indigo源码
在书籍的第6章

1.新建工程

mkdir -p chapter6_tutorials/src
cd src
catkin_create_pkg chapter6_tutorials pcl_ros roscpp rospy sensor_msgs std_msgs 
cd ..
catkin_make

2.编辑主函数pcl_create.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";

    ros::Rate loop_rate(1);
    while (ros::ok())
    {
        pcl_pub.publish(output);
        ros::spinOnce();
        loop_rate.sleep();
    }

    return 0;
}

3.编辑CMakeLists.txt

编辑/chapter6_tutorials/src/chapter6_tutorials路径下CMakeLists.txt加入

find_package(PCL REQUIRED)
include_directories(include${PCL_INCLUDE_DIRS})
link_directories(${PCL_LIBRARY_DIRS})
add_executable(pcl_create src/pcl_create.cpp)
target_link_libraries(pcl_create ${catkin_LIBRARIES} ${PCL_LIBRARIES})