PoseGraph位姿图 mapping2D::PoseGraph类的注释: // Implements the loop closure method called Sparse Pose Adjustment (SPA) from// Konolige, Kurt, et al. "Efficient sparse pose adjustment for 2d mapping."// Intelligent Robots and Systems (IROS), 2010 IEEE/…

约束计算 闭环检测的策略:搜索闭环,通过匹配检测是否是闭环,采用了分支定界法. 前已经述及PoseGraph的内容,此处继续.位姿图类定义了pose_graph::ConstraintBuilder constraint_builder_对象. 1.ConstraintBuilder类图 定义了SubmapScanMatcher的键值对. // Map of already constructed scan matchers by 'submap_id'. std::map<mapping::S…

其实也就是包括两个方面的内容:类似于运动模型的位姿估计和扫描匹配,因为需要计算速度,所以时间就有必要了! 1. PoseExtrapolator解决了IMU数据.里程计和位姿信息进行融合的问题. 该类定义了三个队列. std::deque<TimedPose> timed_pose_queue_; std::deque<sensor::ImuData> imu_data_; std::deque<sensor::OdometryData> odometry_data_;…

LocalTrajectoryBuilder意思是局部轨迹的构建,下面的类图中方法的参数没有画进去. 注意其中的三个类:PoseExtrapolator类,RealTimeCorrelativeScanMatcher类和CeresScanMatcher类. (1)PoseExtrapolator类(如下图),Node类和LocalTrajectoryBuilder类都有用到PoseExtrapolator对象,好像两者之间并没有什么关系? LocalTrajectoryBuilder中的Pose…

MapBuilder的成员变量sensor::Collator sensor_collator_; 再次阅读MapBuilder::AddTrajectoryBuilder方法.首先构造了mapping::GlobalTrajectoryBuilder实例,接着作为参数构造了CollatedTrajectoryBuilder实例. trajectory_builders_.push_back( common::make_unique<CollatedTrajectoryBuilder>( &a…

Cartographer早期的代码在进行3d制图的时候使用了UKF方法,查看现有的tag版本,可以转到0.1.0和0.2.0查看,包含kalman_filter文件夹. 文件夹中的pose_tracker类文件在mapping_3d的文件加下有kalman_local_trajectory_builder.目前这部分代码已经移除,整个代码的结构也发生了较大变动. 项目的主要逻辑结构:https://google-cartographer.readthedocs.io/en/latest/ 当前项…

上文提到特别注意map_builder_bridge_.AddTrajectory(x,x),查看其中的代码.两点: 首先是map_builder_.AddTrajectoryBuilder(...),调用了map_builder_对象的方法.其次是sensor_bridges_键值对的赋值. int MapBuilderBridge::AddTrajectory(const std::unordered_set<std::string>& expected_sensor_ids, c…

带着几个思考问题: (1)IMU数据的使用,如何融合,Kalman滤波? (2)图优化的具体实现,闭环检测的策略? (3)3D激光的接入和闭环策略? 1. 安装Kdevelop工具: http://blog.csdn.net/p942005405/article/details/75715288 http://blog.csdn.net/wan_exe/article/details/56275108 yhexie@ubuntu:~$ sudo apt-get install kdevelop…

IMU的输入为imu_linear_acceleration 和  imu_angular_velocity 线加速和角速度.最终作为属性输出的是方位四元数.  Eigen::Quaterniond orientation() const { return orientation_; } /* * Copyright 2016 The Cartographer Authors * * Licensed under the Apache License, Version 2.0 (the "Lic…

[原]AFNetworking源码阅读(六) 本文转载请注明出处 —— polobymulberry-博客园 1. 前言 这一篇的想讲的,一个就是分析一下AFSecurityPolicy文件,看看AFNetworking的网络安全策略,尤其指HTTPS(大家可以先简单了解下HTTPS).再一个就是分析下AFNetworkReachabilityManager文件,看看AFNetworking如何解决网络状态的检测. 2. AFSecurityPolicy - 网络安全策略 之前我们在AFURLS…