mid360使用cartorapher进行3d建图导航

  1. 添加urdf配置文件:

添加IMU配置关节点和laser关节点

<!-- imu livox -->

<joint name="livox_frame_joint" type="fixed">

<parent link="base_link" />

<child link="livox_frame" />

<origin xyz="0 0 0" rpy="3.1416 0 0" />

</joint>

  1. 配置文件cartographer_ros/configuration_files/backpack_3d.lua

使用base_link

map_frame = "map", --map

tracking_frame = "base_link", --base_link imu_link rslidar

published_frame = "base_link", --base_link rslidar

  1. 配置cartographer_ros/launch/backpack_3d.launch....貌似这个建图的时候配置的,定位没用着!

转换topic:使用mid360的topic!

<remap from="points2" to="/livox/lidar />

<remap from="imu" to="/livox/imu" /> <!-- -->

4.配置 cartographer_ros/configuration_files/backpack_3d_localization.lua

把纯定位给去掉,不知道为什么,应该是pure_localization参数多了一个

include "backpack_3d.lua"

--TRAJECTORY_BUILDER.pure_localization = true

POSE_GRAPH.optimize_every_n_nodes = 100

return options

5.修改 cartographer_ros/launch/3d_local_wish.launch文件,就是3d_localization.launch文件,其它不做任何修改

<remap from="points2" to="/livox/lidar />

<remap from="imu" to="/livox/imu" /> <!-- -->

6.测试launch启动:使用提前建好的图

roslaunch cartographer_ros 3d_local_wish.launch load_map:=/home/wishchin/map3d/innercross.pbstream

结果:mid360的数据就是比较恍眼,定位成功

相关推荐
无聊的小坏坏44 分钟前
力扣 239 题:滑动窗口最大值的两种高效解法
c++·算法·leetcode
黎明smaly1 小时前
【排序】插入排序
c语言·开发语言·数据结构·c++·算法·排序算法
YuTaoShao1 小时前
【LeetCode 热题 100】206. 反转链表——(解法一)值翻转
算法·leetcode·链表
YuTaoShao1 小时前
【LeetCode 热题 100】142. 环形链表 II——快慢指针
java·算法·leetcode·链表
CCF_NOI.1 小时前
(普及−)B3629 吃冰棍——二分/模拟
数据结构·c++·算法
运器1232 小时前
【一起来学AI大模型】支持向量机(SVM):核心算法深度解析
大数据·人工智能·算法·机器学习·支持向量机·ai·ai编程
Zedthm2 小时前
LeetCode1004. 最大连续1的个数 III
java·算法·leetcode
神的孩子都在歌唱2 小时前
3423. 循环数组中相邻元素的最大差值 — day97
java·数据结构·算法
YuTaoShao3 小时前
【LeetCode 热题 100】73. 矩阵置零——(解法一)空间复杂度 O(M + N)
算法·leetcode·矩阵
dying_man3 小时前
LeetCode--42.接雨水
算法·leetcode