V-LOAM 源码解析(一)
转载请注明出处:本文转自zhch_pan的博客http://www.cnblogs.com/zhchp-blog/ 本博客为本人之前做项目时做的源码阅读工作,po到网上希望帮助其他人更好的理解V-LOAM的工程实现,有些地方代码做了修改,可能和原工程有出入,但对于该工程的整体流程理解没有妨碍。 源码下载链接:https://github.com/Jinqiang/demo_lidar 节点名称: featureTracking 订阅topic: <sensor_msgs::Image> ( " /camera/image_raw ") 发布topic: 1、 <sensor_msgs::PointCloud2> ( "/image_points_last " ) 2、<sensor_msgs::Image>( "/image/show " ) 1 #include <math.h> 2 #include <stdio.h> 3 #include <stdlib.h> 4 #include <ros/ros.h> 5 6 #include " cameraParameters.h " 7 #include " pointDefinition.h " 8 9 using namespace std; 10 using namespace cv; 11 12 bool