香港科技大学的VINS_MONO初试
简介 VINS-Mono 是香港科技大学开源的一个VIO,我简单的测试了,发现效果不错。做个简单的笔记,详细的内容等我毕设搞完再弄。 代码主要分为前端(feature tracker),后端(sliding window, loop closure),还加了初始化(visual-imu aligment) Feature tracker 这部分代码在 feature_tracker 包下面,主要是接收图像topic,使用KLT光流算法跟踪特征点,同时保持每一帧图像有最少的(100-300)个特征点。 根据配置文件中的 freq ,确定每隔多久的时候,把检测到的特征点打包成 /feature_tracker/feature topic 发出去, 要是没有达到发送的时间,这幅图像的feature就作为下一时刻的 KLT追踪的特征点,就是不是每一副图像都要处理的,那样计算时间大了,而且数据感觉冗余,帧与帧之间图像的差距不会那么明显。 这里的 freq 配置文件建议至少设置10,为了保证好的前端。 void img_callback(const sensor_msgs::ImageConstPtr &img_msg) { for (int i = 0; i < NUM_OF_CAM; i++) { ROS_DEBUG("processing camera %d", i); if (i !=