zoukankan      html  css  js  c++  java
  • [转]百度Appollo无人车Perception Module 分析

    https://github.com/ApolloAuto/apollo/blob/master/docs/howto/modules/apollo1.5_perception_module_study_notes_cn.md

    功能:

    感知障碍物,预测障碍物的运动轨迹。

    数据流图:

    输入:

    • 点云数据:/apollo/sensor/velodyne64/compensator/PointCloud2。
    • 坐标系转换关系:/tf(world->novatel)。
    • HD Map。
    • LiDAR外参:/tf_static(novatel->velodyne64)。
    • 注:在最小仿真系统中,/tf,/tf_static和HD map都不是以topic形式作为输入的。

    输出:

    • 带航向和速度,障碍物的3D轨道消息:/apollo/perception/obstacles。

    代码分析:

    main.cc:

    • 主节点文件。
    • 通过apollo顶层宏APOLLO_MAIN,创建ros节点Perception。

    perception.h,perception.cc:

    • 模块主体文件。
    • 定义实现Perception类,用于表述perception模块。
    • Name()函数:返回模块名字,也就是ros节点名字,即"perception"。
    • Init()函数:模块初始化函数。AdapterManager::Init()函数通过配置文件adapter.conf创建node handle,以及相应的topics;lidar_process_->Init()函数配置对激光雷达数据处理的算法;检测激光雷达是否有数据;注册点云数据的回调函数。
    • OnPointCloud()函数:数据处理回调函数。判断lidar处理算法是否就绪;lidar_process_->Process()函数使用前面注册的雷达处理算法依次处理雷达数据;lidar_process_->GeneratePbMsg()函数使用处理后的数据生成障碍物信息;AdapterManager::PublishPerceptionObstacles()函数基于adapter架构发布障碍物信息。

    lidar_process.h,lidar_process.c:

    • 激光雷达数据处理文件,主要包含激光雷达的处理算法。
    • 定义实现LidarProcess类,用于处理激光雷达数据。
    • init()函数:RegistAllAlgorithm()函数注册激光雷达处理函数,分别是HdmapROIFilter,CNNSegmentation,MinBoxObjectBuilder,HmObjectTracker其对应的时激光雷达数据处理流程。InitFrameDependence()函数配置HD map。InitAlgorithmPlugin()函数将roi_filter_,segmentor_,object_builder_,tracker_实例化,可能是只作为插件,并调用其init()方法。
    • Process(const sensor_msgs::PointCloud2& message)函数:调用GetVelodyneTrans()函数获取velodyne2world坐标系转化关系,调用TransPointCloudToPCL()函数由Lidar数据生成PCL,存入point_cloud变量。然后调用Process(timestamp_, point_cloud, velodyne_trans)函数。
    • Process(timestamp_, point_cloud, velodyne_trans)函数:hdmap_input_->GetROI()函数从HD map获取ROI;roi_filter_->Filter()函数获取ROI的索引indices;segmentor_->Segment()函数对根据indices对障碍物进行分割,object_builder_->Build()函数重建障碍物,构成6变形;tracker_->Track()函数 预测障碍物运动轨迹。这是perception算法的核心部分,其四个步骤分别使用四中不同的算法,详细算法需要进一步研究。此步结束之后,对激光雷达数据处理结束,剩余部分就是合成障碍物,然后发布出去。

    HD map的引入:

    • HD map的引入是通过hdmap_input.cc和hdmap_input.h文件实现,通过定义HDMapInput类表述和操作HD map。

    激光雷达数据处理算法:

    • 每个算法对应obstaclelidar下的相应的一个目录,每个算法被包装为一个插件类。每种算法都牵涉比较深的相关数学理论知识,后续可将每一项作为专题研究,例如segment,其核心即是CNN算法。
  • 相关阅读:
    POJ3070 Fibonacci[矩阵乘法]【学习笔记】
    NOIP模拟赛20161023
    洛谷P2964 [USACO09NOV]硬币的游戏A Coin Game
    Jmeter之Bean shell使用
    jmeter 之 BeanShell PostProcessor跨线程全局变量使用
    详解JMeter函数和变量
    性能测试指标(图表)
    http协议基础(十一)http与https
    http协议进阶(六)代理
    http协议进阶(五)连接管理
  • 原文地址:https://www.cnblogs.com/qiuheng/p/9151428.html
Copyright © 2011-2022 走看看