马上开学，目前学校很多实验室都是人工智能这块，大部分都是和机器人相关，然后软件这块就是和cv、ros相关，就打算开始学习一下。
本章节是虚拟机安装Ubuntu18.04以及安装ROS的环境。
学习教程：【Autolabor初级教程】ROS机器人入门，博客中一些知识点是来源于赵老师的笔记在线笔记，本博客主要是做归纳总结，如有侵权请联系删除。
视频中的案例都基本敲了遍，这里给出我自己的源代码文件：
链接：https://pan.baidu.com/s/13CAzXk0vAWuBsc4oABC-_g
提取码：0hws
所有博客文件目录索引：博客目录索引(持续更新)
关键技术有如下五点:
geometry_msgs/Twist类型的消息来实现运动。slam介绍
SLAM问题可以描述为: 机器人在未知环境中从一个未知位置开始移动,在移动过程中根据位置估计和地图进行自身定位，同时在自身定位的基础上建造增量式地图，以绘制出外部环境的完全地图。
SLAM 实现的技术如：gmapping、hector_slam、cartographer、rgbdslam、ORB_SLAM …
完成SLAM依赖的物理传感器（需要获取周围环境深度信息的能力）：激光雷达、摄像头、RGB-D摄像头…
总结：SLAM 虽然是机器人导航的重要技术之一，但是 二者并不等价，确切的讲，SLAM 只是实现地图构建和即时定位。
amcl介绍
amcl(adaptiveMonteCarloLocalization)：自适应的蒙特卡洛定位,是用于2D移动机器人的概率定位系统。它实现了自适应（或KLD采样）蒙特卡洛定位方法，该方法使用粒子过滤器根据已知地图跟踪机器人的姿态。
move_base
该功能包由两大规划器组成：
1、全局路径规划(gloable_planner)：根据给定的目标点和全局地图实现总体的路径规划，使用 Dijkstra 或 A* 算法进行全局路径规划，计算最优路线，作为全局路线、
2、本地时时规划(local_planner)：在实际导航过程中，机器人可能无法按照给定的全局最优路线运行，比如:机器人在运行中，可能会随时出现一定的障碍物… 本地规划的作用就是使用一定算法(Dynamic Window Approaches) 来实现障碍物的规避，并选取当前最优路径以尽量符合全局最优路径。
全局路径规划与本地路径规划是相对的，全局路径规划侧重于全局、宏观实现，而本地路径规划侧重与当前、微观实现。
运动控制
导航功能包集假定它可以通过话题"cmd_vel"发布geometry_msgs/Twist类型的消息，这个消息基于机器人的基座坐标系，它传递的是运动命令。这意味着必须有一个节点订阅"cmd_vel"话题， 将该话题上的速度命令转换为电机命令并发送。
环境感知
感知周围环境信息，比如: 摄像头、激光雷达、编码器…，摄像头。
例如：激光雷达可以用于感知外界环境的深度信息，编码器可以感知电机的转速信息，进而可以获取速度信息并生成里程计信息。
介绍
定位：就是参考某个坐标系(比如:以机器人的出发点为原点创建坐标系)在该坐标系中标注机器人。
定位实现需要依赖于机器人自身，机器人需要逆向推导参考系原点并计算坐标系相对关系，该过程实现常用方式有两种：
两者特点
两者来进行配合最佳，前者根据行驶的距离来进行定位，后者则是依据不同的位置来进行定位：
坐标系变换
机器人坐标系一般使用机器人模型中的根坐标系(base_link 或 base_footprint)
当二者结合使用时，map 和 odom 都是机器人模型根坐标系的父级，这是不符合坐标变换中"单继承"的原则的，所以，一般会将转换关系设置为: map -> doom -> base_link 或 base_footprint。
安装ROS下面章节各个导航包：
# 安装 gmapping 包(用于构建地图)
sudo apt install ros-melodic-gmapping
# 安装地图服务包(用于保存与读取地图)
sudo apt install ros-melodic-map-server
# 安装 navigation 包(用于定位以及路径规划)
sudo apt install ros-melodic-navigation
创建新的工程包：
# 进入到工程下的src目录
cd /home/workspace/roslearn/src
# 创建名为08nav_demo的包
catkin_create_pkg --rosdistro melodic 08nav_demo gmapping map_server amcl move_base
官网：gmapping
介绍：gmapping 是ROS开源社区中较为常用且比较成熟的SLAM算法之一，gmapping可以根据移动机器人里程计数据和激光雷达数据来绘制二维的栅格地图。
gmapping包对于硬件的要求：
gmapping功能包的核心节点：slam_gmapping，需要额外关注的是该节点订阅的话题、发布的话题、服务以及相关参数。
订阅topic
tf (tf/tfMessage)：用于雷达、底盘与里程计之间的坐标变换消息。
scan(sensor_msgs/LaserScan)：SLAM所需的雷达信息。
发布topic
map_metadata(nav_msgs/MapMetaData)：地图元数据，包括地图的宽度、高度、分辨率等，该消息会固定更新。
map(nav_msgs/OccupancyGrid)：地图栅格数据，一般会在rviz中以图形化的方式显示。
~entropy(std_msgs/Float64)：机器人姿态分布熵估计(值越大，不确定性越大)。
服务service
dynamic_map(nav_msgs/GetMap)：用于获取地图数据。
参数（常见参数）
~base_frame(string, default:“base_link”)：机器人基坐标系。
~map_frame(string, default:“map”)：地图坐标系。
~odom_frame(string, default:“odom”)：里程计坐标系。
~map_update_interval(float, default: 5.0)：地图更新频率，根据指定的值设计更新间隔。
~maxUrange(float, default: 80.0)：激光探测的最大可用范围(超出此阈值，被截断)。
~maxRange(float)：激光探测的最大范围。
所需的坐标变换
雷达坐标系→基坐标系：一般由 robot_state_publisher 或 static_transform_publisher 发布。
基坐标系→里程计坐标系：一般由里程计节点发布。
发布的坐标变换
地图坐标系→里程计坐标系：地图到里程计坐标系之间的变换。
步骤一：编写slam的launch文件
nav01_slam.launch：其中包含了gmapping的一个包对于slam的具体实现以及rviz的配置
<launch>
<param name="use_sim_time" value="true"/>
<node pkg="gmapping" type="slam_gmapping" name="slam_gmapping" output="screen">
<remap from="scan" to="scan"/><!-- 雷达话题 -->
<param name="base_frame" value="base_footprint"/><!--底盘坐标系-->
<param name="odom_frame" value="odom"/> <!--里程计坐标系-->
<param name="map_update_interval" value="5.0"/>
<param name="maxUrange" value="16.0"/>
<param name="sigma" value="0.05"/>
<param name="kernelSize" value="1"/>
<param name="lstep" value="0.05"/>
<param name="astep" value="0.05"/>
<param name="iterations" value="5"/>
<param name="lsigma" value="0.075"/>
<param name="ogain" value="3.0"/>
<param name="lskip" value="0"/>
<param name="srr" value="0.1"/>
<param name="srt" value="0.2"/>
<param name="str" value="0.1"/>
<param name="stt" value="0.2"/>
<param name="linearUpdate" value="1.0"/>
<param name="angularUpdate" value="0.5"/>
<param name="temporalUpdate" value="3.0"/>
<param name="resampleThreshold" value="0.5"/>
<param name="particles" value="30"/>
<param name="xmin" value="-50.0"/>
<param name="ymin" value="-50.0"/>
<param name="xmax" value="50.0"/>
<param name="ymax" value="50.0"/>
<param name="delta" value="0.05"/>
<param name="llsamplerange" value="0.01"/>
<param name="llsamplestep" value="0.01"/>
<param name="lasamplerange" value="0.005"/>
<param name="lasamplestep" value="0.005"/>
</node>
<node pkg="joint_state_publisher" name="joint_state_publisher" type="joint_state_publisher" />
<node pkg="robot_state_publisher" name="robot_state_publisher" type="robot_state_publisher" />
<!-- <node pkg="rviz" type="rviz" name="rviz" /> -->
<!-- 可以保存 rviz 配置并后期直接使用-->
<node pkg="rviz" type="rviz" name="rviz" args="-d $(find 08nav_demo)/conf/gmapping.rviz"/>
</launch>
步骤二：依次启动Gazebo、slam的launch文件以及键盘控制
# 启动gazebo(第7章节部分的，复用之前的)
roslaunch 07urdf_gazebo demo03_evn.launch
# 启动slam及rviz
roslaunch 08nav_demo nav01_slam.launch
# 启动键盘控制
rosrun teleop_twist_keyboard teleop_twist_keyboard.py
rviz打开之后，来添加一个map组件：指定订阅主题为/map
令小车进行自转来完成建图工作：
# 向/cmd_vel主题去发布消息
rostopic pub -r 10 /cmd_vel geometry_msgs/Twist linear:
x: 0.0
y: 0.0
z: 0.0
angular:
x: 0.0
y: 0.0
z: 0.3"
通过使用gmapping的构建地图并在rviz中显示了地图，此时地图数据还是保存在内存中，此时就有个问题对于构建地图之后若是服务程序结束，那么下次就需要重新建立，如何解决呢？此时就涉及到了地图的持久化存储。
本质：会将地图数据进行序列化持久存储到磁盘中，后期会进行反序列话读取地图数据。
此时我们就可以使用ros中的map_server包来进行地图的持久化存储！
介绍map_server：map_server功能包中提供了两个节点: map_saver 和 map_server，前者用于将栅格地图保存到磁盘，后者读取磁盘的栅格地图并以服务的方式提供出去。
订阅的topic
map(nav_msgs/OccupancyGrid)：订阅此话题用于生成地图文件。
前提说明：需要在SLAM建图完成之后，我们才可进行一个地图保存服务（启动2.1中的案例后再去执行该地图保存服务）。
nav02_map_save.launch：
<launch>
<arg name="filename" value="$(find 08nav_demo)/map/nav" />
<node name="map_save" pkg="map_server" type="map_saver" args="-f $(arg filename)" />
</launch>
接着我们可以去用键盘控制小车移动，等待地图绘制完成后，我们就可以去执行地图保存服务了！
# 运行地图保存服务
roslaunch 08nav_demo nav02_map_save.launch
效果如下：
nav02_map_read.launch·：
<launch>
<!-- 设置地图的配置文件 -->
<arg name="map" default="nav.yaml" />
<!-- 运行地图服务器，并且加载设置的地图-->
<node name="map_server" pkg="map_server" type="map_server" args="$(find 08nav_demo)/map/$(arg map)"/>
</launch>
我们可以在首先先启动地图服务读取节点，这样我们再去运行rviz后，选择map组件即可看到原先绘制的map地图了：
# 运行地图读取服务
roslaunch 08nav_demo nav02_map_read.launch
amcl已经被集成到了navigation包。
认识：``AMCL`(adaptive Monte Carlo Localization) 是用于2D移动机器人的概率定位系统，它实现了自适应（或KLD采样）蒙特卡洛定位方法，可以根据已有地图使用粒子滤波器推算机器人位置。
订阅topic
scan(sensor_msgs/LaserScan)：激光雷达数据。
tf(tf/tfMessage)：坐标变换消息。
initialpose(geometry_msgs/PoseWithCovarianceStamped)：用来初始化粒子滤波器的均值和协方差。
map(nav_msgs/OccupancyGrid)：获取地图数据。
发布的Topic
amcl_pose(geometry_msgs/PoseWithCovarianceStamped)：机器人在地图中的位姿估计。
particlecloud(geometry_msgs/PoseArray)：位姿估计集合，rviz中可以被 PoseArray 订阅然后图形化显示机器人的位姿估计集合。
tf(tf/tfMessage)：发布从 odom 到 map 的转换。
提供的服务service
global_localization(std_srvs/Empty)：初始化全局定位的服务。
request_nomotion_update(std_srvs/Empty)：手动执行更新和发布更新的粒子的服务。
set_map(nav_msgs/SetMap)：手动设置新地图和姿态的服务。
调用的服务
static_map(nav_msgs/GetMap)：调用此服务获取地图数据。
常见参数
~odom_model_type(string, default:“diff”)：里程计模型选择: “diff”,“omni”,“diff-corrected”,“omni-corrected” (diff 差速、omni 全向轮)
~odom_frame_id(string, default:“odom”)：里程计坐标系。
~base_frame_id(string, default:“base_link”)：机器人极坐标系。
~global_frame_id(string, default:“map”)：地图坐标系。
里程计本身也是可以协助机器人定位的，不过里程计存在累计误差且一些特殊情况时(车轮打滑)会出现定位错误的情况，amcl 则可以通过估算机器人在地图坐标系下的姿态，再结合里程计提高定位准确度。
前提说明：需要预先准备好全局地图配置信息。
步骤一：编写amcl的配置文件
nav03_amcl.launch：
<launch>
<node pkg="amcl" type="amcl" name="amcl" output="screen">
<!-- Publish scans from best pose at a max of 10 Hz -->
<param name="odom_model_type" value="diff"/><!-- 里程计模式为差分 -->
<param name="odom_alpha5" value="0.1"/>
<param name="transform_tolerance" value="0.2" />
<param name="gui_publish_rate" value="10.0"/>
<param name="laser_max_beams" value="30"/>
<param name="min_particles" value="500"/>
<param name="max_particles" value="5000"/>
<param name="kld_err" value="0.05"/>
<param name="kld_z" value="0.99"/>
<param name="odom_alpha1" value="0.2"/>
<param name="odom_alpha2" value="0.2"/>
<!-- translation std dev, m -->
<param name="odom_alpha3" value="0.8"/>
<param name="odom_alpha4" value="0.2"/>
<param name="laser_z_hit" value="0.5"/>
<param name="laser_z_short" value="0.05"/>
<param name="laser_z_max" value="0.05"/>
<param name="laser_z_rand" value="0.5"/>
<param name="laser_sigma_hit" value="0.2"/>
<param name="laser_lambda_short" value="0.1"/>
<param name="laser_lambda_short" value="0.1"/>
<param name="laser_model_type" value="likelihood_field"/>
<!-- <param name="laser_model_type" value="beam"/> -->
<param name="laser_likelihood_max_dist" value="2.0"/>
<param name="update_min_d" value="0.2"/>
<param name="update_min_a" value="0.5"/>
<param name="odom_frame_id" value="odom"/><!-- 里程计坐标系 -->
<param name="base_frame_id" value="base_footprint"/><!-- 添加机器人基坐标系 -->
<param name="global_frame_id" value="map"/><!-- 添加地图坐标系 -->
<param name="resample_interval" value="1"/>
<param name="transform_tolerance" value="0.1"/>
<param name="recovery_alpha_slow" value="0.0"/>
<param name="recovery_alpha_fast" value="0.0"/>
</node>
</launch>
步骤二：配置测试launch文件（集成地图读取服务、rviz以及amcl定位）
nav03_amcl_test.launch·：
<!-- 测试文件 -->
<launch>
<!-- 加载地图服务 -->
<include file="$(find 08nav_demo)/launch/nav02_map_read.launch" />
<!-- 启动rviz -->
<node pkg="joint_state_publisher" name="joint_state_publisher" type="joint_state_publisher" />
<node pkg="robot_state_publisher" name="robot_state_publisher" type="robot_state_publisher" />
<node pkg="rviz" type="rviz" name="rviz" args="-d $(find 08nav_demo)/conf/gmapping.rviz"/>
<!-- amcl文件 -->
<include file="$(find 08nav_demo)/launch/nav03_amcl.launch" />
</launch>
接着来运行各个服务节点：
# 启动gazebo(第7章节部分的，复用之前的)
roslaunch 07urdf_gazebo demo03_evn.launch
# 启动amcl测试文件（集成map读取、rviz、amcl）
roslaunch 08nav_demo nav03_amcl_test.launch
# 启动键盘控制
rosrun teleop_twist_keyboard teleop_twist_keyboard.py
打开rviz后需要添加PoseArray组件，并且订阅/particlecloud主题：
接着我们控制键盘来让小车进行移动，接着我们来查看效果：
move_base已经被集成到了navigation包。
介绍：move_base 功能包提供了基于动作(action)的路径规划实现，move_base 可以根据给定的目标点，控制机器人底盘运动至目标位置，并且在运动过程中会连续反馈机器人自身的姿态与目标点的状态信息。
组成：move_base主要由全局路径规划与本地路径规划组成。
动作订阅
move_base/goal(move_base_msgs/MoveBaseActionGoal)：move_base 的运动规划目标。
move_base/cancel(actionlib_msgs/GoalID)：取消目标。
动作发布
move_base/feedback(move_base_msgs/MoveBaseActionFeedback)：连续反馈的信息，包含机器人底盘坐标。
move_base/status(actionlib_msgs/GoalStatusArray)：发送到move_base的目标状态信息。
move_base/result(move_base_msgs/MoveBaseActionResult)：操作结果(此处为空)。
订阅topic
move_base_simple/goal(geometry_msgs/PoseStamped)：运动规划目标(与action相比，没有连续反馈，无法追踪机器人执行状态)。
发布topic
cmd_vel(geometry_msgs/Twist)：输出到机器人底盘的运动控制消息。
服务
~make_plan(nav_msgs/GetPlan)：请求该服务，可以获取给定目标的规划路径，但是并不执行该路径规划。
~clear_unknown_space(std_srvs/Empty)：允许用户直接清除机器人周围的未知空间。
~clear_costmaps(std_srvs/Empty)：允许清除代价地图中的障碍物，可能会导致机器人与障碍物碰撞，请慎用。
ROS中的地图其实就是一张图片，这张图片有宽度、高度、分辨率等元数据，在图片中使用灰度值来表示障碍物存在的概率。
不过SLAM构建的地图在导航中是不可以直接使用的，主要原因如下：
静态地图无法直接应用于导航，其基础之上需要添加一些辅助信息的地图，比如实时获取的障碍物数据，基于静态地图添加的膨胀区等数据。
组成：global_costmap(全局代价地图) 和 local_costmap(本地代价地图)
两张代价地图都可以多层叠加,一般有以下层级:
碰撞算法：
上图中，横轴是距离机器人中心的距离，纵轴是代价地图中栅格的灰度值。
膨胀空间的设置可以参考非自由空间。
步骤一：编写move_base配置
nav04_path.launch：在该launch文件中包含了多个配置项
<launch>
<node pkg="move_base" type="move_base" respawn="false" name="move_base" output="screen" clear_params="true">
<rosparam file="$(find 08nav_demo)/param/costmap_common_params.yaml" command="load" ns="global_costmap" />
<rosparam file="$(find 08nav_demo)/param/costmap_common_params.yaml" command="load" ns="local_costmap" />
<rosparam file="$(find 08nav_demo)/param/local_costmap_params.yaml" command="load" />
<rosparam file="$(find 08nav_demo)/param/global_costmap_params.yaml" command="load" />
<rosparam file="$(find 08nav_demo)/param/base_local_planner_params.yaml" command="load" />
</node>
</launch>
步骤二：编写各类配置文件
base_local_planner_params.yaml：
TrajectoryPlannerROS:
# Robot Configuration Parameters
max_vel_x: 0.5 # X 方向最大速度
min_vel_x: 0.1 # X 方向最小速速
max_vel_theta: 1.0 #
min_vel_theta: -1.0
min_in_place_vel_theta: 1.0
acc_lim_x: 1.0 # X 加速限制
acc_lim_y: 0.0 # Y 加速限制
acc_lim_theta: 0.6 # 角速度加速限制
# Goal Tolerance Parameters，目标公差
xy_goal_tolerance: 0.10
yaw_goal_tolerance: 0.05
# Differential-drive robot configuration
# 是否是全向移动机器人
holonomic_robot: false
# Forward Simulation Parameters，前进模拟参数
sim_time: 0.8
vx_samples: 18
vtheta_samples: 20
sim_granularity: 0.05
costmap_common_params.yaml：
#机器人几何参，如果机器人是圆形，设置 robot_radius,如果是其他形状设置 footprint
robot_radius: 0.12 #圆形
# footprint: [[-0.12, -0.12], [-0.12, 0.12], [0.12, 0.12], [0.12, -0.12]] #其他形状
obstacle_range: 3.0 # 用于障碍物探测，比如: 值为 3.0，意味着检测到距离小于 3 米的障碍物时，就会引入代价地图
raytrace_range: 3.5 # 用于清除障碍物，比如：值为 3.5，意味着清除代价地图中 3.5 米以外的障碍物
#膨胀半径，扩展在碰撞区域以外的代价区域，使得机器人规划路径避开障碍物
inflation_radius: 0.2
#代价比例系数，越大则代价值越小
cost_scaling_factor: 3.0
#地图类型
map_type: costmap
#导航包所需要的传感器
observation_sources: scan
#对传感器的坐标系和数据进行配置。这个也会用于代价地图添加和清除障碍物。例如，你可以用激光雷达传感器用于在代价地图添加障碍物，再添加kinect用于导航和清除障碍物。
scan: {sensor_frame: laser, data_type: LaserScan, topic: scan, marking: true, clearing: true}
global_costmap_params.yaml：
global_costmap:
global_frame: map #地图坐标系
robot_base_frame: base_footprint #机器人坐标系
# 以此实现坐标变换
update_frequency: 1.0 #代价地图更新频率
publish_frequency: 1.0 #代价地图的发布频率
transform_tolerance: 0.5 #等待坐标变换发布信息的超时时间
static_map: true # 是否使用一个地图或者地图服务器来初始化全局代价地图，如果不使用静态地图，这个参数为false.
local_costmap_params.yaml：
local_costmap:
global_frame: odom #里程计坐标系
robot_base_frame: base_footprint #机器人坐标系
update_frequency: 10.0 #代价地图更新频率
publish_frequency: 10.0 #代价地图的发布频率
transform_tolerance: 0.5 #等待坐标变换发布信息的超时时间
static_map: false #不需要静态地图，可以提升导航效果
rolling_window: true #是否使用动态窗口，默认为false，在静态的全局地图中，地图不会变化
width: 3 # 局部地图宽度 单位是 m
height: 3 # 局部地图高度 单位是 m
resolution: 0.05 # 局部地图分辨率 单位是 m，一般与静态地图分辨率保持一致
步骤三：编写路径规划测试文件
nav05_path_test.launch：
<launch>
<!-- 设置地图的配置文件 -->
<arg name="map" default="nav.yaml" />
<!-- 运行地图服务器，并且加载设置的地图-->
<node name="map_server" pkg="map_server" type="map_server" args="$(find 08nav_demo)/map/$(arg map)"/>
<!-- slam（重新绘制地图使用） -->
<!-- <include file="$(find 08nav_demo)/launch/nav01_slam.launch" /> -->
<!-- 启动AMCL节点 -->
<include file="$(find 08nav_demo)/launch/nav03_amcl.launch" />
<!-- 运行move_base节点 -->
<include file="$(find 08nav_demo)/launch/nav04_path.launch" />
<!-- 运行rviz -->
<node pkg="joint_state_publisher" name="joint_state_publisher" type="joint_state_publisher" />
<node pkg="robot_state_publisher" name="robot_state_publisher" type="robot_state_publisher" />
<node pkg="rviz" type="rviz" name="rviz" args="-d $(find 08nav_demo)/conf/gmapping.rviz"/>
</launch>
此时我们就可以来运行节点了：
# 启动gazebo(第7章节部分的，复用之前的)
roslaunch 07urdf_gazebo demo03_evn.launch
# 运行路径规划测试launch（地图加载、amcl、movebase、rviz）
roslaunch 08nav_demo nav05_path_test.launch
接着我们使用2D Nav Goal来指定目标位置来进行移动：
若是我们在行进的过程中放置障碍物，也能够实现自主避障，到达目的地：
订阅全局地图：我们可以重新在rviz中添加一个map，重命名为map_global，订阅主题为/move_base/global_costmap/costmap
订阅本地map地图：订阅主题为/move_base/global_costmap/costmap
nav06_auto_slam.launch：
<launch>
<!-- 启动SLAM节点 -->
<include file="$(find 08nav_demo)/launch/nav01_slam.launch" />
<!-- 运行move_base节点 -->
<include file="$(find 08nav_demo)/launch/nav04_path.launch" />
<!-- 运行rviz（在slim节点中已经有了） -->
<!-- <node pkg="joint_state_publisher" name="joint_state_publisher" type="joint_state_publisher" />
<node pkg="robot_state_publisher" name="robot_state_publisher" type="robot_state_publisher" />
<node pkg="rviz" type="rviz" name="rviz" args="-d $(find 08nav_demo)/conf/gmapping.rviz"/> -->
</launch>
接着运行launch文件来启动服务：
# 启动gazebo(第7章节部分的，复用之前的)
roslaunch 07urdf_gazebo demo03_evn.launch
# 仅仅只包含slam、move_base、rviz节点
roslaunch 08nav_demo nav06_auto_slam.launch
在rviz中我们打开了全局地图、本地地图，初始还没有完整建图的效果如下：
以往我们需要使用的之前的键盘来操控小车移动，这里的话我们就可以直接使用2D Naw Goal来进行手动定位目的地来完成建图！
最终的效果如下：
等待建图完成之后，我们就可以去保存全局地图了：
# 同样也是执行之前的全局地图命令保存节点
roslaunch 08nav_demo nav02_map_save.launch
上面的各个导航服务集成都使用到了消息组件，对应组件就需要使用到相关消息的发布、订阅。
地图相关的消息主要有两个:
1、nav_msgs/MapMetaData：地图元数据，包括地图的宽度、高度、分辨率等。
# 查看消息体命令
rosmsg info nav_msgs/MapMetaData
# 消息结构如下：
time map_load_time
float32 resolution #地图分辨率
uint32 width #地图宽度
uint32 height #地图高度
geometry_msgs/Pose origin #地图位姿数据
geometry_msgs/Point position
float64 x
float64 y
float64 z
geometry_msgs/Quaternion orientation
float64 x
float64 y
float64 z
float64 w
2、nav_msgs/OccupancyGrid：地图栅格数据，一般会在rviz中以图形化的方式显示。
# 查看消息体命令
rosmsg info nav_msgs/OccupancyGrid
# 消息结构如下：
std_msgs/Header header
uint32 seq
time stamp
string frame_id
#--- 地图元数据
nav_msgs/MapMetaData info
time map_load_time
float32 resolution
uint32 width
uint32 height
geometry_msgs/Pose origin
geometry_msgs/Point position
float64 x
float64 y
float64 z
geometry_msgs/Quaternion orientation
float64 x
float64 y
float64 z
float64 w
#--- 地图内容数据，数组长度 = width * height
int8[] data
里程计相关消息是：nav_msgs/Odometry
# 查看消息体命令
rosmsg info nav_msgs/Odometry
# 消息结构如下：
std_msgs/Header header
uint32 seq
time stamp
string frame_id
string child_frame_id
geometry_msgs/PoseWithCovariance pose
geometry_msgs/Pose pose #里程计位姿
geometry_msgs/Point position
float64 x
float64 y
float64 z
geometry_msgs/Quaternion orientation
float64 x
float64 y
float64 z
float64 w
float64[36] covariance
geometry_msgs/TwistWithCovariance twist
geometry_msgs/Twist twist #速度
geometry_msgs/Vector3 linear
float64 x
float64 y
float64 z
geometry_msgs/Vector3 angular
float64 x
float64 y
float64 z
# 协方差矩阵
float64[36] covariance
坐标变换相关消息是：tf/tfMessage
# 查看消息体命令
rosmsg info tf/tfMessage
# 消息结构如下：
geometry_msgs/TransformStamped[] transforms #包含了多个坐标系相对关系数据的数组
std_msgs/Header header
uint32 seq
time stamp
string frame_id
string child_frame_id
geometry_msgs/Transform transform
geometry_msgs/Vector3 translation
float64 x
float64 y
float64 z
geometry_msgs/Quaternion rotation
float64 x
float64 y
float64 z
float64 w
3.4、导航—定位
定位相关消息是：geometry_msgs/PoseArray
# 查看消息体命令
rosmsg info geometry_msgs/PoseArray
# 消息结构如下：
std_msgs/Header header
uint32 seq
time stamp
string frame_id
geometry_msgs/Pose[] poses #预估的点位姿组成的数组
geometry_msgs/Point position
float64 x
float64 y
float64 z
geometry_msgs/Quaternion orientation
float64 x
float64 y
float64 z
float64 w
目标点相关消息是：move_base_msgs/MoveBaseActionGoal
# 查看消息体命令
rosmsg info move_base_msgs/MoveBaseActionGoal
# 消息结构如下：
std_msgs/Header header
uint32 seq
time stamp
string frame_id
actionlib_msgs/GoalID goal_id
time stamp
string id
move_base_msgs/MoveBaseGoal goal
geometry_msgs/PoseStamped target_pose
std_msgs/Header header
uint32 seq
time stamp
string frame_id
geometry_msgs/Pose pose #目标点位姿
geometry_msgs/Point position
float64 x
float64 y
float64 z
geometry_msgs/Quaternion orientation
float64 x
float64 y
float64 z
float64 w
路径规划相关消息是：nav_msgs/Path
# 查看消息体命令
rosmsg info nav_msgs/Path
# 消息结构如下：
std_msgs/Header header
uint32 seq
time stamp
string frame_id
geometry_msgs/PoseStamped[] poses #由一系列点组成的数组
std_msgs/Header header
uint32 seq
time stamp
string frame_id
geometry_msgs/Pose pose
geometry_msgs/Point position
float64 x
float64 y
float64 z
geometry_msgs/Quaternion orientation
float64 x
float64 y
float64 z
float64 w
激光雷达相关消息是：sensor_msgs/LaserScan
# 查看消息体命令
rosmsg info sensor_msgs/LaserScan
# 消息结构如下：
std_msgs/Header header
uint32 seq
time stamp
string frame_id
float32 angle_min #起始扫描角度(rad)
float32 angle_max #终止扫描角度(rad)
float32 angle_increment #测量值之间的角距离(rad)
float32 time_increment #测量间隔时间(s)
float32 scan_time #扫描间隔时间(s)
float32 range_min #最小有效距离值(m)
float32 range_max #最大有效距离值(m)
float32[] ranges #一个周期的扫描数据
float32[] intensities #扫描强度数据，如果设备不支持强度数据，该数组为空
对应的一般的图像数据：sensor_msgs/Image
# 查看消息体命令
rosmsg info sensor_msgs/Image
# 消息结构如下：
std_msgs/Header header
uint32 seq
time stamp
string frame_id
uint32 height #高度
uint32 width #宽度
string encoding #编码格式:RGB、YUV等
uint8 is_bigendian #图像大小端存储模式
uint32 step #一行图像数据的字节数，作为步进参数
uint8[] data #图像数据，长度等于 step * height
对应压缩后的图像数据：sensor_msgs/CompressedImage
# 查看消息体命令
rosmsg info sensor_msgs/CompressedImage
# 消息结构如下：
std_msgs/Header header
uint32 seq
time stamp
string frame_id
string format #压缩编码格式(jpeg、png、bmp)
uint8[] data #压缩后的数据
点云数据(带有深度信息的图像数据)：sensor_msgs/PointCloud2
# 查看消息体命令
rosmsg info sensor_msgs/PointCloud2
# 消息结构如下：
std_msgs/Header header
uint32 seq
time stamp
string frame_id
uint32 height #高度
uint32 width #宽度
sensor_msgs/PointField[] fields #每个点的数据类型
uint8 INT8=1
uint8 UINT8=2
uint8 INT16=3
uint8 UINT16=4
uint8 INT32=5
uint8 UINT32=6
uint8 FLOAT32=7
uint8 FLOAT64=8
string name
uint32 offset
uint8 datatype
uint32 count
bool is_bigendian #图像大小端存储模式
uint32 point_step #单点的数据字节步长
uint32 row_step #一行数据的字节步长
uint8[] data #存储点云的数组，总长度为 row_step * height
bool is_dense #是否有无效点
ros功能包：depthimage_to_laserscan，该功能包可以将深度图像信息转换成激光雷达信息。
应用场景：在诸多SLAM算法中，一般都需要订阅激光雷达数据用于构建地图，因为激光雷达可以感知周围环境的深度信息，而深度相机也具备感知深度信息的功能，且最初激光雷达价格比价比较昂贵，实际上传感器选型可以使用深度相机来去替代激光雷达。
原理：depthimage_to_laserscan将实现深度图像与雷达数据转换的原理比较简单，雷达数据是二维的、平面的，深度图像是三维的，是若干二维(水平)数据的纵向叠加，如果将三维的数据转换成二维数据，只需要取深度图的某一层即可，为了方面理解。
优缺点：
订阅topic
image(sensor_msgs/Image)：输入图像信息。
camera_info(sensor_msgs/CameraInfo)：关联图像的相机信息。通常不需要重新映射，因为camera_info将从与image相同的命名空间中进行订阅。
发布topic
scan(sensor_msgs/LaserScan)：发布转换成的激光雷达类型数据。
参数
该节点参数较少，只有如下几个，一般需要设置的是: output_frame_id。
~scan_height(int, default: 1 pixel)：设置用于生成激光雷达信息的象素行数。
~scan_time(double, default: 1/30.0Hz (0.033s))：两次扫描的时间间隔。
~range_min(double, default: 0.45m)：返回的最小范围。结合range_max使用，只会获取 range_min 与 range_max 之间的数据。
~range_max(double, default: 10.0m)：返回的最大范围。结合range_min使用，只会获取 range_min 与 range_max 之间的数据。
~output_frame_id(str, default: camera_depth_frame)：激光信息的ID。
# 安装depthimage-to-laserscan
sudo apt-get install ros-melodic-depthimage-to-laserscan
nav07_depthimage_to_laserscan.launch：编写launch文件执行，将深度信息转换成雷达信息
<launch>
<node pkg="depthimage_to_laserscan" type="depthimage_to_laserscan" name="depthimage_to_laserscan">
<remap from="image" to="/camera/depth/image_raw" />
<param name="output_frame_id" value="camera" />
</node>
</launch>
接着我们来启动各个launch文件：
# 启动gazebo(第7章节部分的，复用之前的)
roslaunch 07urdf_gazebo demo03_evn.launch
# 深度图像转激光数据
roslaunch 08nav_demo nav07_depthimage_to_laserscan.launch
# 运行路径规划测试launch（地图加载、amcl、movebase、rviz）
roslaunch 08nav_demo nav05_path_test.launch
在rviz中添加一个雷达扫描：
效果展示：
我是rails的新手，想在form字段上应用验证。myviewsnew.html.erb.....模拟.rbclassSimulation{:in=>1..25,:message=>'Therowmustbebetween1and25'}end模拟Controller.rbclassSimulationsController我想检查模型类中row字段的整数范围，如果不在范围内则返回错误信息。我可以检查上面代码的范围，但无法返回错误消息提前致谢 最佳答案 关键是您使用的是模型表单，一种显示ActiveRecord模型实例属性的表单。c
这似乎非常适得其反，因为太多的gem会在window上破裂。我一直在处理很多mysql和ruby-mysqlgem问题(gem本身发生段错误，一个名为UnixSocket的类显然在Windows机器上不能正常工作，等等)。我只是在浪费时间吗？我应该转向不同的脚本语言吗？ 最佳答案 我在Windows上使用Ruby的经验很少，但是当我开始使用Ruby时，我是在Windows上，我的总体印象是它不是Windows原生系统。因此，在主要使用Windows多年之后，开始使用Ruby促使我切换回原来的系统Unix，这次是Linux。Rub
我的工作要求我为某些测试自动生成电子邮件。我一直在四处寻找，但未能找到可以快速实现的合理解决方案。它需要在outlook而不是其他邮件服务器中，因为我们有一些奇怪的身份验证规则，我们需要保存草稿而不是仅仅发送邮件的选项。显然win32ole可以做到这一点，但我找不到任何相当简单的例子。 最佳答案 假设存储了Outlook凭据并且您设置为自动登录到Outlook，WIN32OLE可以很好地完成此操作:require'win32ole'outlook=WIN32OLE.new('Outlook.Application')message=
我正在使用Ruby，我正在与一个网络端点通信，该端点在发送消息本身之前需要格式化“header”。header中的第一个字段必须是消息长度，它被定义为网络字节顺序中的2二进制字节消息长度。比如我的消息长度是1024。如何将1024表示为二进制双字节？ 最佳答案 Ruby(以及Perl和Python等)中字节整理的标准工具是pack和unpack。ruby的packisinArray.您的长度应该是两个字节长，并且按网络字节顺序排列，这听起来像是n格式说明符的工作:n|Integer|16-bitunsigned,network(bi
目录前言滤波电路科普主要分类实际情况单位的概念常用评价参数函数型滤波器简单分析滤波电路构成低通滤波器RC低通滤波器RL低通滤波器高通滤波器RC高通滤波器RL高通滤波器部分摘自《LC滤波器设计与制作》，侵权删。前言最近需要学习放大电路和滤波电路，但是由于只在之前做音乐频谱分析仪的时候简单了解过一点点运放，所以也是相当从零开始学习了。滤波电路科普主要分类滤波器：主要是从不同频率的成分中提取出特定频率的信号。有源滤波器：由RC元件与运算放大器组成的滤波器。可滤除某一次或多次谐波，最普通易于采用的无源滤波器结构是将电感与电容串联，可对主要次谐波（3、5、7）构成低阻抗旁路。无源滤波器：无源滤波器，又称
如果我在模型中设置验证消息validates:name,:presence=>{:message=>'Thenamecantbeblank.'}我如何让该消息显示在闪光警报中，这是我迄今为止尝试过的方法defcreate@message=Message.new(params[:message])if@message.valid?ContactMailer.send_mail(@message).deliverredirect_to(root_path,:notice=>"Thanksforyourmessage,Iwillbeintouchsoon")elseflash[:error]
RSpec似乎按顺序匹配方法接收的消息。我不确定如何使以下代码工作:allow(a).toreceive(:f)expect(a).toreceive(:f).with(2)a.f(1)a.f(2)a.f(3)我问的原因是a.f的一些调用是由我的代码的上层控制的，所以我不能对这些方法调用添加期望。 最佳答案 RSpecspy是测试这种情况的一种方式。要监视一个方法，用allowstub，除了方法名称之外没有任何约束，调用该方法，然后expect确切的方法调用。例如:allow(a).toreceive(:f)a.f(2)a.f(1)
require"socket"server="irc.rizon.net"port="6667"nick="RubyIRCBot"channel="#0x40"s=TCPSocket.open(server,port)s.print("USERTesting",0)s.print("NICK#{nick}",0)s.print("JOIN#{channel}",0)这个IRC机器人没有连接到IRC服务器，我做错了什么？ 最佳答案 失败并显示此消息::irc.shakeababy.net461*USER:Notenoughparame
我以为它们存储在cookie中-但不，检查cookie没有任何结果。session也不存储它们。那么，我在哪里可以找到它们？我需要这个来直接设置它们(而不是通过flashhash)。 最佳答案 它们存储在inyoursessionstore.自rails2.0以来的默认设置是cookie存储，但请检查config/initializers/session_store.rb以检查您是否使用默认设置以外的东西。 关于ruby-on-rails-闪存消息存储在哪里？，我们在StackOverf
我有一个放在lib/network中的类:moduleNetworkApiclassNetworkProxyendend然后在另一个类中，我引用了这个类:network_proxy=::NetworkApi::NetworkProxy.new(params)一切都在我的开发环境中正常运行，但是当我部署到服务器时，我在上面一行收到错误消息:NameError:uninitializedconstantNetworkApi::NetworkProxy我不知道为什么会出现这个奇怪的错误。请告诉我为什么。 最佳答案 请注意Rails5dis