【cartographer】机器人使用vlp-16多线雷达建图参数配置

本文主要是介绍【cartographer】机器人使用vlp-16多线雷达建图参数配置,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

目录

  • 1、lua文件配置
    • option部分参数修改
    • TRAJECTORY_BUILDER_2D部分参数修改
    • POSE_GRAPH部分参数修改
  • 2、launch文件
    • 需要修改的参数

环境:
ubuntu 20.04 + ros1 noetic
gazebo 11
机器人有urdf,tf树最上层为base_link,无里程计和imu
直接使用vlp-16点云数据建cartographer 2d图

用过里程计,但没有用过imu,所以文章内容不太能给使用imu的人提供参考
文章内容如有错误,欢迎指出交流。

1、lua文件配置

include "map_builder.lua"
include "trajectory_builder.lua"options = {map_builder = MAP_BUILDER,trajectory_builder = TRAJECTORY_BUILDER,map_frame = "map",tracking_frame = "base_link",published_frame = "base_link",odom_frame = "odom",provide_odom_frame = true,publish_frame_projected_to_2d = false,use_pose_extrapolator = true,use_odometry = false,use_nav_sat = false,use_landmarks = false,num_laser_scans = 0,num_multi_echo_laser_scans = 0,num_subdivisions_per_laser_scan = 1,num_point_clouds = 1,lookup_transform_timeout_sec = 0.2,submap_publish_period_sec = 0.3,pose_publish_period_sec = 5e-3,trajectory_publish_period_sec = 30e-3,rangefinder_sampling_ratio = 1.,odometry_sampling_ratio = 1.,fixed_frame_pose_sampling_ratio = 1.,imu_sampling_ratio = 1.,landmarks_sampling_ratio = 1.,
}MAP_BUILDER.use_trajectory_builder_2d = trueTRAJECTORY_BUILDER_2D.num_accumulated_range_data = 1
TRAJECTORY_BUILDER_2D.min_range = 0.5
TRAJECTORY_BUILDER_2D.max_range = 30.
TRAJECTORY_BUILDER_2D.min_z = -0.03
TRAJECTORY_BUILDER_2D.max_z = 1.5
TRAJECTORY_BUILDER_2D.missing_data_ray_length = 5.
TRAJECTORY_BUILDER_2D.use_imu_data = false
TRAJECTORY_BUILDER_2D.use_online_correlative_scan_matching = true
TRAJECTORY_BUILDER_2D.real_time_correlative_scan_matcher.linear_search_window = 0.1
TRAJECTORY_BUILDER_2D.real_time_correlative_scan_matcher.translation_delta_cost_weight = 10.
TRAJECTORY_BUILDER_2D.real_time_correlative_scan_matcher.rotation_delta_cost_weight = 1e-1
TRAJECTORY_BUILDER_2D.motion_filter.max_angle_radians = math.rad(0.5)TRAJECTORY_BUILDER_2D.submaps.num_range_data = 35.POSE_GRAPH.optimization_problem.huber_scale = 1e1
POSE_GRAPH.optimize_every_n_nodes = 70
POSE_GRAPH.constraint_builder.min_score = 0.65return options

option部分参数修改

一般主要改这几个参数,

  tracking_frame = "base_link",published_frame = "base_link",provide_odom_frame = true,use_odometry = false,

tracking_frame一般是base_footprint或者base_link,有时也可能是laser_link(比如手持雷达建图的情况)。
published_frame最好选机器人tf树最上层那个frame_id。
如果你的机器人有里程计,那一般tf树最上层就是odom,provide_odom_frame应改为false,use_odometry应改为true。
注意,因为vlp-16的gazebo插件发布的是点云数据,所以num_point_clouds改为你雷达的数量,别在num_laser_scans里改。
一般建图报错说找不到map都是lua文件参数配置的不对,可以去参考一下参数详细说明

TRAJECTORY_BUILDER_2D部分参数修改

TRAJECTORY_BUILDER_2D.min_range = 0.5
TRAJECTORY_BUILDER_2D.max_range = 30.
TRAJECTORY_BUILDER_2D.min_z = -0.03
TRAJECTORY_BUILDER_2D.max_z = 1.5

这四个参数规定了cartographer读取的点云数据范围,如果建图时无障碍物的地方也出现了很多的雷达波纹(地上一圈一圈的),就要调整min_z参数,因为可能扫到地面上,把地板检测为障碍物了。

TRAJECTORY_BUILDER_2D.submaps.num_range_data = 35.

如果建出来的图边缘重影较多,可以尝试调小这个参数,推荐20-40

TRAJECTORY_BUILDER_2D.motion_filter.max_angle_radians = math.rad(0.5)

如果建图时移动机器人发现无障碍物的空地总有灰色区域,经过好几次都还是扫不上,那就可能是这个参数太大了,将math.rad括号里的数调小,但不建议低于0.1。

POSE_GRAPH部分参数修改

POSE_GRAPH.optimize_every_n_nodes = 70

推荐设为TRAJECTORY_BUILDER_2D.submaps.num_range_data的2倍,如果不要后端优化,设置为0。

2、launch文件

<launch><param name="/use_sim_time" value="true" /><node name="cartographer_node" pkg="cartographer_ros"type="cartographer_node" args="-configuration_directory $(find cartographer_ros)/configuration_files-configuration_basename robot_simple_2d.lua"output="screen"><remap from="points2" to="/velodyne_points" /></node><node name="cartographer_occupancy_grid_node" pkg="cartographer_ros"type="cartographer_occupancy_grid_node" args="-resolution 0.05" /><node name="rviz" pkg="rviz" type="rviz" required="true"  args="-d $(find cartographer_ros)/configuration_files/demo_2d.rviz" /> 
</launch>

由于我启动机器人gazebo仿真时会发布robot_description和robot_state_publisher,所以这里不再重复发布,如果是实机要加上,或者声明tf变换。

需要修改的参数

-configuration_basename后面要改为你自己的lua文件名字
<remap from="points2" to="/velodyne_points" /> to里面的话题去找下面这个插件里的topicName,保持一致。

<plugin name="gazebo_ros_laser_controller" filename="libgazebo_ros_velodyne_laser.so"><topicName>/velodyne_points</topicName><frameName>laser_link</frameName><organize_cloud>false</organize_cloud><min_range>0.1</min_range><max_range>30.0</max_range><gaussianNoise>0.008</gaussianNoise>
</plugin>

更新:
我在最近的一次尝试里发现下图的草坪不能很好被判定为障碍物在这里插入图片描述建图效果如下:在这里插入图片描述
能看出来这个线很虚,如果小车走近些,会变得更深一些,线也会多一些,但是我走远以后,这个草坪如果又进入了雷达的扫描范围,这根线就消失了。但是如果我把点云数据转成laserscan数据,就不会有这种现象。
以我目前的理解,是因为这个草坪模型垂直面太少了,而cartographer的2d建图不太能处理斜坡(或者说类斜坡?)的数据,可能会把它当成不太平整的地面处理。我的解决办法是把点云数据转成laserscan数据或者直接改用3d建图。
如果对这个问题有什么想法和建议欢迎和我交流!

这篇关于【cartographer】机器人使用vlp-16多线雷达建图参数配置的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/305250

相关文章

vue使用docxtemplater导出word

《vue使用docxtemplater导出word》docxtemplater是一种邮件合并工具,以编程方式使用并处理条件、循环,并且可以扩展以插入任何内容,下面我们来看看如何使用docxtempl... 目录docxtemplatervue使用docxtemplater导出word安装常用语法 封装导出方

Linux换行符的使用方法详解

《Linux换行符的使用方法详解》本文介绍了Linux中常用的换行符LF及其在文件中的表示,展示了如何使用sed命令替换换行符,并列举了与换行符处理相关的Linux命令,通过代码讲解的非常详细,需要的... 目录简介检测文件中的换行符使用 cat -A 查看换行符使用 od -c 检查字符换行符格式转换将

使用Jackson进行JSON生成与解析的新手指南

《使用Jackson进行JSON生成与解析的新手指南》这篇文章主要为大家详细介绍了如何使用Jackson进行JSON生成与解析处理,文中的示例代码讲解详细,感兴趣的小伙伴可以跟随小编一起学习一下... 目录1. 核心依赖2. 基础用法2.1 对象转 jsON(序列化)2.2 JSON 转对象(反序列化)3.

使用Python实现快速搭建本地HTTP服务器

《使用Python实现快速搭建本地HTTP服务器》:本文主要介绍如何使用Python快速搭建本地HTTP服务器,轻松实现一键HTTP文件共享,同时结合二维码技术,让访问更简单,感兴趣的小伙伴可以了... 目录1. 概述2. 快速搭建 HTTP 文件共享服务2.1 核心思路2.2 代码实现2.3 代码解读3.

Elasticsearch 在 Java 中的使用教程

《Elasticsearch在Java中的使用教程》Elasticsearch是一个分布式搜索和分析引擎,基于ApacheLucene构建,能够实现实时数据的存储、搜索、和分析,它广泛应用于全文... 目录1. Elasticsearch 简介2. 环境准备2.1 安装 Elasticsearch2.2 J

使用C#代码在PDF文档中添加、删除和替换图片

《使用C#代码在PDF文档中添加、删除和替换图片》在当今数字化文档处理场景中,动态操作PDF文档中的图像已成为企业级应用开发的核心需求之一,本文将介绍如何在.NET平台使用C#代码在PDF文档中添加、... 目录引言用C#添加图片到PDF文档用C#删除PDF文档中的图片用C#替换PDF文档中的图片引言在当

Java中List的contains()方法的使用小结

《Java中List的contains()方法的使用小结》List的contains()方法用于检查列表中是否包含指定的元素,借助equals()方法进行判断,下面就来介绍Java中List的c... 目录详细展开1. 方法签名2. 工作原理3. 使用示例4. 注意事项总结结论:List 的 contain

C#使用SQLite进行大数据量高效处理的代码示例

《C#使用SQLite进行大数据量高效处理的代码示例》在软件开发中,高效处理大数据量是一个常见且具有挑战性的任务,SQLite因其零配置、嵌入式、跨平台的特性,成为许多开发者的首选数据库,本文将深入探... 目录前言准备工作数据实体核心技术批量插入:从乌龟到猎豹的蜕变分页查询:加载百万数据异步处理:拒绝界面

Android中Dialog的使用详解

《Android中Dialog的使用详解》Dialog(对话框)是Android中常用的UI组件,用于临时显示重要信息或获取用户输入,本文给大家介绍Android中Dialog的使用,感兴趣的朋友一起... 目录android中Dialog的使用详解1. 基本Dialog类型1.1 AlertDialog(

Python使用自带的base64库进行base64编码和解码

《Python使用自带的base64库进行base64编码和解码》在Python中,处理数据的编码和解码是数据传输和存储中非常普遍的需求,其中,Base64是一种常用的编码方案,本文我将详细介绍如何使... 目录引言使用python的base64库进行编码和解码编码函数解码函数Base64编码的应用场景注意