首页 >> 大全

ROS Moveit 配置全网最详细教程

2024-01-08 大全 39 作者:考证青年

是一个机器人爱好者组织,欢迎参与我们上的开源项目

目录 的安装

笔者制作了一键配置安装来方便使用,这个一键配置安装脚本也会根据用户需求看是否额外下载的基础教程示例,辅助用户学习。

复制以下指令到命令行,一键进行配置安装

wget -O $HOME/moveit1_install.sh https://raw.githubusercontent.com/auromix/ros-install-one-click/main/moveit1_install.sh && sudo chmod +x $HOME/moveit1_install.sh && sudo bash $HOME/moveit1_install.sh && rm $HOME/moveit1_install.sh

的使用

根据作为一键配置安装的基础教程示例的Panda机械臂,有如下使用方式在RViz中进行简单使用。

roslaunch panda_moveit_config demo.launch

roslaunch panda_moveit_config demo_gazebo.launch

具体的使用方式,在使用一键配置安装脚本时会有提示。

配置包的文件解析

fig里面有太多的文件,通常会让用户感到头疼,以下对这些配置包里的各个内容作详细的解析,可根据需求查阅。

如果希望对中的经典demo有所了解,推荐阅读demo.和.文件切片解析

切片解析1: demo.

文件名为//demo.,是的经典demo,在RViz中显示机器人模型并通过RViz的插件来控制完成运动规划和轨迹控制。

以下为官方案例的//demo.完整代码:

<launch><arg name="arm_id" default="panda" /><arg name="pipeline" default="ompl" /><arg name="db" default="false" /><arg name="db_path" default="$(find panda_moveit_config)/default_warehouse_mongo_db" /><arg name="debug" default="false" /><arg name="load_gripper" default="true" /><arg name="load_robot_description" default="true"/><arg name="moveit_controller_manager" default="fake" /><arg name="fake_execution_type" default="interpolate" /><arg name="transmission" />                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                <arg name="use_gui" default="false" /><arg name="use_rviz" default="true" /><arg name="rviz_tutorial" default="false" /><node pkg="tf2_ros" type="static_transform_publisher" name="virtual_joint_broadcaster_0" args="0 0 0 0 0 0 world $(arg arm_id)_link0" /><group if="$(eval arg('moveit_controller_manager') == 'fake')"><node name="joint_state_publisher" pkg="joint_state_publisher" type="joint_state_publisher" unless="$(arg use_gui)"><rosparam param="source_list">[move_group/fake_controller_joint_states]rosparam>node><node name="joint_state_publisher" pkg="joint_state_publisher_gui" type="joint_state_publisher_gui" if="$(arg use_gui)"><rosparam param="source_list">[move_group/fake_controller_joint_states]rosparam>node><node name="robot_state_publisher" pkg="robot_state_publisher" type="robot_state_publisher" respawn="true" output="screen" />group><include file="$(dirname)/move_group.launch" pass_all_args="true"><arg name="allow_trajectory_execution" value="true" /><arg name="info" value="true" />include><include file="$(dirname)/moveit_rviz.launch" if="$(arg use_rviz)"><arg name="rviz_tutorial" value="$(arg rviz_tutorial)"/><arg name="rviz_config" value="$(dirname)/moveit.rviz"/><arg name="debug" value="$(arg debug)"/>include><include file="$(dirname)/default_warehouse_db.launch" if="$(arg db)"><arg name="moveit_warehouse_database_path" value="$(arg db_path)"/>include>launch>

对于代码中的各个部分,有以下解析:

  <arg name="arm_id" default="panda" /># 机器人的标识符。这个参数指定在机器人有多个实现时使用哪一个。# 当多机器人协同时,标识符可以用来区分它们。默认值设置为“panda”

  <arg name="pipeline" default="ompl" /># 机器人运动规划的管道。# MoveIt提供了几种规划算法,例如OMPL、SBPL等。此参数允许用户选择使用哪种算法进行运动规划。默认值为“ompl”。

关于OMPL(Open )算法,可参考OMPL官方文档、OMPL

db&

  <!-- By default, we do not start a database (it can be large) --><arg name="db" default="false" /><!-- Allow user to specify database location --><arg name="db_path" default="$(find panda_moveit_config)/default_warehouse_mongo_db" /># db:指定是否启动运动规划数据库。# 如果设为true,MoveIt会启动MongoDB数据库来存储或检索运动规划数据。默认值为false。# db_path:指定运动规划数据库的路径。# 这个参数允许用户指定MongoDB数据库的位置。默认值设置为“$(find panda_moveit_config)/default_warehouse_mongo_db”。

运动规划数据通常是指用于机器人或移动设备规划运动路径的数据,例如,目标位置、机器人当前位置、避障信息等。

在中,的作用是提供持久化的存储方式,以保存完整的计划场景和机器人状态。通过使用适当的存储插件(如或),用户可以将场景和状态保存到或等不同的后端数据库中。这使得用户可以在不同的时间和地点重新加载和使用保存的场景和状态。

除了提供持久化存储的功能之外,还可以用于数据查询、过滤和排序。通过使用提供的接口,用户可以方便地从中检索和获取他们所需要的场景和状态。这对于机器人操作中的实时计划和决策非常有用,因为它可以快速地检索到特定的场景和状态,而无需每次都重新计算或重新生成它们。

是一个流行的文档式(NoSQL)数据库,它以二进制JSON格式存储数据。与传统的关系型数据库不同,的结构灵活,适合存储半结构化数据或任意类型的文档。

关于在中使用数据库来存储和调用运动规划数据,可参考

debug

  <!-- By default, we are not in debug mode --><arg name="debug" default="false" /># debug:指定是否启用RViz调试模式。如果设为true,则启用RViz中的调试模式。默认为false。# 该参数也会被传递给move_group.launch,用于开启move_group的GDB调试。

RViz debug mode可以帮助开发人员诊断和解决问题。在调试模式下,Rviz可以显示更多的调试信息,例如ROS消息的内容和接收频率,帧率信息,以及RViz可视化中使用的资源和内存使用情况等。

这些信息可以帮助开发人员快速定位和解决问题,例如调试节点之间的通信问题、可视化资源的使用情况等。同时,调试模式还可以显式地显示Rviz中各种可视化元素的名称,标签和坐标信息, 以便更好的理解和调整要素的位置动态。

  <!-- By default we will load the gripper --><arg name="load_gripper" default="true" /># load_gripper:指定是否加载机器人夹爪的控制器。此参数用于加载和配置夹爪的运动控制器。默认值为true。# 该参数将通过 pass_all_args="true" 属性被传递给move_group.launch

on

  <!-- By default, we will load or override the robot_description --><arg name="load_robot_description" default="true"/># 指定是否加载或覆盖机器人描述。MoveIt需要知道机器人的描述才能进行规划和控制。# 这个参数用于加载机器人的URDF文件或覆盖已有的机器人描述。默认值为true。# 该参数将通过 pass_all_args="true" 属性被传递给move_group.launch

on将机器人的描述文件(通常为urdf或sdf格式)加载到ROS参数服务器中。如果on参数为true,则会加载或覆盖先前设置的机器人描述文件。如果为false,则使用先前加载的机器人描述文件。

的发布通过r节点来实现。该节点从参数服务器中获取机器人的描述信息,计算机器人每个联动部件的变换,并发布机器人的tf树和关节状态信息。 节点接收tf和关节状态信息,用于运动规划和执行。

nager

  <!-- Choose controller manager: fake, simple, or ros_control --><arg name="moveit_controller_manager" default="fake" /># moveit_controller_manager:选择控制器管理器的类型。# 控制器管理器用于加载和配置机器人的控制器。# MoveIt提供了几种类型的控制器管理器,包括“fake”,“simple”和“ros_control”。默认值为“fake”。

提供的控制器管理器包括以下三种类型:

fake: 这种类型的控制器仅模拟运动,不与真实机器人进行通信。它通常用于快速测试和演示,对于仿真,通常使用fake控制器来模拟运动。

: 这种类型的控制器与机器人进行通信,但仅提供了基本控制,例如直线/圆弧插值等。它适用于一些较简单的机器人。

: 这是一种更灵活的控制器类型,可支持各种机器人和控制器硬件。它提供了更高级别的控制接口,例如电机控制器接口和传感器读取接口。

根据应用场景和机器人的要求,使用不同类型的控制器管理器。

是机器人强大的控制器,可参考 WIKI文档和源代码

图片来源:ROS WIKI

  <!-- Set execution mode for fake execution controllers -->
<arg name="fake_execution_type" default="interpolate" /># fake_execution_type:设置虚拟控制器的执行模式。# 如果选择“fake”控制器管理器,则使用虚拟控制器进行模拟运动。# 此参数指定用于虚拟运动的执行模式,包括“interpolate”,“last point。默认值为“interpolate”。

:该选项表示假设控制器将在轨迹的每个目标点之间进行插值。这种方式可以模拟连续的轨迹执行过程。

last point:此选项表示假设控制器将直接跳到轨迹的最后一个目标点。这种方式可以模拟机器人快速执行任务。

在/..xml文件中发现了这两种描述,不确定是否有第三种via 来和官方文档中关于fake 的描述匹配。

但在官方文档中有关于fake 的详细描述,可参考 官方文档

提供了一系列虚拟轨迹控制器,可用于模拟。其中,虚拟控制器的配置文件位于 /.yaml 。

可以根据需要调整以下控制器类型:

虚拟控制器类型信息可在 .yaml 文件中配置。对于每个控制器,都需要指定名称、类型和涉及的关节。其中,频率为 rate: 10,可用于插补控制器。但在对夹爪进行控制时,关节为空列表 []。

示例:

rate: 10
controller_list:- name: fake_arm_controllertype: interpolatejoints:- joint_1- joint_2- joint_3- joint_4- joint_5- joint_6- name: fake_gripper_controllerjoints:[]

  <!-- Transmission used for joint control: position, velocity, or effort --><arg name="transmission" /> # 设置用于关节控制的传输类型。这个参数用来选择传输类型,例如position、velocity或effort。# 默认情况下,这个参数未设置,不用理会。    

  <!-- By default, hide joint_state_publisher's GUI in 'fake' controller_manager mode --><arg name="use_gui" default="false" /># use_gui:指定是否显示joint_state_publisher的GUI界面。# 如果设为true,则会在启动期间打开一个窗口,显示机器人的关节姿态。默认值为false。

在的demo.中,设置了一个默认的假控制器管理器(fake )模式,这意味着没有实际的控制器与机械臂连接。

在这种模式下,r发布的关节状态信息是通过话题获得,隐藏其图形用户界面(GUI)可以避免用户误操作。因此,默认情况下隐藏r的GUI可以增加系统的可靠性。

  <arg name="use_rviz" default="true" /># use_rviz:指定是否启用RViz。如果此参数设为true,则MoveIt将启动RViz进行可视化。默认值为true。

  <!-- Use rviz config for MoveIt tutorial --><arg name="rviz_tutorial" default="false" /># rviz_tutorial:指定是否使用RViz配置进行MoveIt教程演示。# 如果设为true,则MoveIt将加载RViz演示配置。默认值为false。

虚拟关节静态TF节点

  <!-- If needed, broadcast static tf for robot root --><node pkg="tf2_ros" type="static_transform_publisher" name="virtual_joint_broadcaster_0" args="0 0 0 0 0 0 world $(arg arm_id)_link0" /># 广播虚拟关节的静态变换# 将world坐标系映射到机器人的物理坐标系中的起点$(arg arm_id)_link0

通过使用虚拟关节,引入一个虚拟的“基准”点,来描述机器人在其环境中的位置,可以将机器人的关节状态映射到物理世界中的位置和姿态,以便进行逆运动学计算,规划器可以使用这些信息来规划运动轨迹或生成机器人姿态。

关节状态及机器人整体状态

  <group if="$(eval arg('moveit_controller_manager') == 'fake')"><!-- We do not have a real robot connected, so publish fake joint states via a joint_state_publisherMoveIt's fake controller's joint states are considered via the 'source_list' parameter --><node name="joint_state_publisher" pkg="joint_state_publisher" type="joint_state_publisher" unless="$(arg use_gui)"><rosparam param="source_list">[move_group/fake_controller_joint_states]</rosparam></node><!-- If desired, a GUI version is available allowing to move the simulated robot around manuallyThis corresponds to moving around the real robot without the use of MoveIt. --><node name="joint_state_publisher" pkg="joint_state_publisher_gui" type="joint_state_publisher_gui" if="$(arg use_gui)"><rosparam param="source_list">[move_group/fake_controller_joint_states]</rosparam></node><!-- Given the published joint states, publish tf for the robot links --><node name="robot_state_publisher" pkg="robot_state_publisher" type="robot_state_publisher" respawn="true" output="screen" /></group># 如果moveit_controller_manager的类型是fake# 则启动joint_state_publisher和robot_state_publisher# 默认不启用joint_state_publisher_gui,以防用户在图形化窗口不小心调节了关节状态值

xml

如果不熟悉这个代码片段里用到的ROS1 XML语言,可参考ROS1 文档

group的作用

这一个节点组group的作用是当的控制器管理器被设为fake类型时,该节点组会发布虚拟的机器人的关节状态/,然后通过机器人状态发布器发布虚拟机器人的/tf话题,以便在 RViz 订阅该/tf话题并在RViz中显示虚拟机器人的状态。

在这个group中,与r一起使用的还有r节点,它用于模拟发布关节状态信息。r会定期发布/类型的/话题,其中包含机器人各个关节的状态信息。r会订阅这些消息,并根据机器人的URDF模型计算机器人各个部件的位姿信息,并发布/tf话题,最终完成机器人状态的更新和发布。

图解各节点关系

由可知在这个demo中的各个节点及话题关系:

/ 节点发布//话题/r节点订阅//话题/r节点发布/话题/r节点订阅/话题/r节点发布/tf话题虚拟关节静态TF节点发布/tf话题/订阅/tf话题,类型为RViz订阅/tf话题

r

Joint State 是一个 ROS 包,用于发布机器人非固定关节的关节状态/, 话题类型为/ 。

在读取机器人的URDF 描述 参数后,它会识别所有非固定关节,创建具有这些非固定关节的 消息,来设置和发布机器人关节状态值joint state 。

它可以与 r 一起使用,以发布所有关节状态的变换。

r的输入

r订阅来自参数服务器的,找到机器人描述中的所有非固定关节,并发布带有这些关节状态值的/类型消息。

r可将作为输入,这是一个带有多个话题名的字符串列表,默认为空,将需要订阅的各个话题名填入其中,这些要订阅的话题是关于关节状态值的,话题类型也为/

在GUI模式下,r_gui能够接收来自r_gui图形化窗口工具的直接关节状态值(比如角度),这个状态值由用户拖动角度条来赋予。

在这个的案例中,/r节点订阅了来自/的//话题,参数的内容为[/]

r的输出

r节点发布包含机器人关节name,位置,速度和力度级别等的/话题,话题类型为/

r

Robot State 是一个ROS包,负责发布机器人整体运动学链的状态信息,包括关节和链路名称、父子关系以及每个链路的位置和方向等信息。该包对于在 RViz 或其他可视化工具中可视化机器人姿态至关重要。

它利用参数服务器中的 参数指定的通用机器人描述格式(URDF)和来自 / 话题,话题类型为/msg/的关节状态值组,来计算机器人的正向运动学,并发布/tf话题。

r的输入

r在启动时会从参数服务器中的 加载机器人的运动学树模型URDF,可以通过启动文件传递参数,其值为机器人的URDF描述字符串。

同时,r要订阅话题,获取每个关节的状态值信息。

这些关节状态信息joint 用于更新运动学树模型,进而计算出机器人各个杆件Link的3D位姿信息Pose

r的输出

对于固定关节,r将发布/话题,类型为/msg/

对于可动关节,r发布/tf话题,类型为/msg/

固定关节的位姿信息会在节点启动时发布到/话题,这些信息将在历史记录中保存。而可动关节的位姿信息会在/话题接收到相应关节状态的更新时,及时发布到/tf话题中。

关于具体的使用例子,可以查看Gihub r

图片来源:ROS WIKI r

加载

  <!-- Run the main MoveIt executable without trajectory execution (we do not have controllers configured by default) --><include file="$(dirname)/move_group.launch" pass_all_args="true"><arg name="allow_trajectory_execution" value="true" /><arg name="info" value="true" /></include># 启动move_group.launch来加载move_group相关内容# 通过pass_all_args="true" 将demo.launch文件的所有arg参数传递给move_group.launch作为参数# 设置 allow_trajectory_execution 为 true,# 可以让 move_group 在运行过程中尝试让机器人执行这些预定义的轨迹# 但如果该参数设置为 false,则只会规划但不会执行规划的轨迹,机器人将保持静止# 此功能对于测试和调试非常有用,因为它允许操纵轨迹,而无需在机器人上实际执行它们# 它在关注安全的情况下也很有用,因为它提供了一种防止意外执行危险轨迹的方法# 如果将 info 设置为 true,则 move_group 会在控制台输出调试信息

="true"是将所有的 传入的参数都传递给Child 的一个属性。

在的demo.文件中,="true"被用于将 的所有arg参数传递给Child ,这意味着,Child 可以获取到来自 的所有参数,并继承它们。

在这个案例中,也就是将demo.的所有arg内参传递给.。

注意,如果不设置="true",Child 将只接收在标记中明确列举的参数。只传递标记中明确列举的参数有助于在嵌套时控制参数不发生混乱。

加载RViz

  <!-- Run Rviz and load the default config to see the state of the move_group node --><include file="$(dirname)/moveit_rviz.launch" if="$(arg use_rviz)"><arg name="rviz_tutorial" value="$(arg rviz_tutorial)"/><arg name="rviz_config" value="$(dirname)/moveit.rviz"/><arg name="debug" value="$(arg debug)"/></include># 当use_rviz=true时运行moveit_rviz.launch文件# 并传递参数rviz_tutorial用于选择是否使用Moveit RViz教学模式# rviz_config的值用于打开同目录下的/moveit.rviz配置文件# debug的值用来设置是否开启RViz的debug模式

加载数据库

  <!-- If database loading was enabled, start mongodb as well --><include file="$(dirname)/default_warehouse_db.launch" if="$(arg db)"><arg name="moveit_warehouse_database_path" value="$(arg db_path)"/></include># 当参数db=true时,运行default_warehouse_db.launch# 向default_warehouse_db.launch传入参数moveit_warehouse_database_path,参数值为该数据库的路径

切片解析2: .

文件名为//.,用于启动节点和相关的功能,节点是软件包中的一个关键组件,它提供了一种接口,用于执行的各种功能,例如规划、执行、运动学计算等。

它通过与运动控制硬件和规划器交互,实现机器人运动的规划和执行。

.文件在//demo.中作为Child 文件被启动。

以下为官方案例的//.完整代码:

<launch><arg name="debug" default="false" /><arg unless="$(arg debug)" name="launch_prefix" value="" /><arg     if="$(arg debug)" name="launch_prefix"value="gdb -x $(dirname)/gdb_settings.gdb --ex run --args" /><arg name="info" default="$(arg debug)" /><arg unless="$(arg info)" name="command_args" value="" /><arg     if="$(arg info)" name="command_args" value="--debug" /><arg name="pipeline" default="ompl" /><arg name="allow_trajectory_execution" default="true"/><arg name="moveit_controller_manager" default="simple" /><arg name="fake_execution_type" default="interpolate"/><arg name="max_safe_path_cost" default="1"/><arg name="publish_monitored_planning_scene" default="true"/><arg name="capabilities" default=""/><arg name="disable_capabilities" default=""/><arg name="load_gripper" default="true" /><arg name="transmission" default="effort" /><arg name="arm_id" default="panda" /><arg name="load_robot_description" default="true" /><include file="$(dirname)/planning_context.launch"><arg name="load_robot_description" value="$(arg load_robot_description)" /><arg name="load_gripper" value="$(arg load_gripper)" /><arg name="arm_id" value="$(arg arm_id)" />include><group ns="move_group/planning_pipelines"><include file="$(dirname)/planning_pipeline.launch.xml"><arg name="pipeline" value="ompl" /><arg name="arm_id" value="$(arg arm_id)" />include><include file="$(dirname)/planning_pipeline.launch.xml"><arg name="pipeline" value="chomp" /><arg name="arm_id" value="$(arg arm_id)" />include><include file="$(dirname)/planning_pipeline.launch.xml"><arg name="pipeline" value="pilz_industrial_motion_planner" /><arg name="arm_id" value="$(arg arm_id)" />include><include if="$(eval arg('pipeline') not in ['ompl', 'chomp', 'pilz_industrial_motion_planner'])"file="$(dirname)/planning_pipeline.launch.xml"><arg name="pipeline" value="$(arg pipeline)" /><arg name="arm_id" value="$(arg arm_id)" />include>group><include ns="move_group" file="$(dirname)/trajectory_execution.launch.xml" pass_all_args="true" if="$(arg allow_trajectory_execution)"><arg name="moveit_manage_controllers" value="true" />include><include ns="move_group" file="$(dirname)/sensor_manager.launch.xml" if="$(arg allow_trajectory_execution)"><arg name="moveit_sensor_manager" value="panda" />include><node name="move_group" launch-prefix="$(arg launch_prefix)" pkg="moveit_ros_move_group" type="move_group" respawn="false" output="screen" args="$(arg command_args)"><env name="DISPLAY" value="$(optenv DISPLAY :0)" /><param name="allow_trajectory_execution" value="$(arg allow_trajectory_execution)"/><param name="sense_for_plan/max_safe_path_cost" value="$(arg max_safe_path_cost)"/><param name="default_planning_pipeline" value="$(arg pipeline)" /><param name="capabilities" value="$(arg capabilities)" /><param name="disable_capabilities" value="$(arg disable_capabilities)" /><param name="planning_scene_monitor/publish_planning_scene" value="$(arg publish_monitored_planning_scene)" /><param name="planning_scene_monitor/publish_geometry_updates" value="$(arg publish_monitored_planning_scene)" /><param name="planning_scene_monitor/publish_state_updates" value="$(arg publish_monitored_planning_scene)" /><param name="planning_scene_monitor/publish_transforms_updates" value="$(arg publish_monitored_planning_scene)" />node>launch>

GDB

  <!-- GDB Debug Option --><arg name="debug" default="false" /><arg unless="$(arg debug)" name="launch_prefix" value="" /><arg     if="$(arg debug)" name="launch_prefix"value="gdb -x $(dirname)/gdb_settings.gdb --ex run --args" /># GDB Debug Option:用于设置是否启用GDB调试。# 当 GDB debug模式关闭时,launch_prefix值为空# 当 GDB debug模式开启时,launch_launch_prefix为GDB相关命令

GNU (GDB),是 Linux 平台下最常用的一款程序调试器。GDB 编译器通常以 gdb 命令的形式在终端(Shell)中使用。

调试工具可使被调试程序在指定代码处暂停运行,并查看当前程序的运行状态(例如当前变量的值,函数的执行结果等),也就是断点调试。

通过调试可以了解程序中出现的逻辑错误。

是自带GDB调试工具的:

test@ubuntu:~$ gdb -v  # Check the version of GDB
GNU gdb (Ubuntu 9.2-0ubuntu1~20.04.1) 9.2
Copyright (C) 2020 Free Software Foundation, Inc.
License GPLv3+: GNU GPL version 3 or later <http://gnu.org/licenses/gpl.html>
This is free software: you are free to change and redistribute it.
There is NO WARRANTY, to the extent permitted by law.

在这个代码片段中

gdb: 是 GNU 调试器(GDB)的命令,它用于调试程序并跟踪其执行过程。

.gdb包含一系列的GDB命令和调试设置,用于在调试过程中自动执行一些操作。

这些命令脚本文件可以包含启动GDB会话时要执行的初始化命令,设置断点,指定观察点,配置调试选项,执行一系列的调试操作以及其他自定义的GDB命令。通过编写调试脚本,可以自动执行一系列的调试操作,以节省手动输入命令的时间和精力。

在//文件夹下并未发现该文件,可能会自动生成或者的开发者不希望用户使用

gdb -x $()/.gdb中的-x使得.gdb脚本文件被加载到GDB中,这将使GDB执行.gdb脚本文件文件中定义的命令和操作。

--ex run选项告诉 GDB 在启动调试器后立即执行 run 命令,使需要调试的程序开始运行。

--args 选项后面可以跟随要调试的程序及其参数。

在这个案例中,通过启用debug模式,使得为GDB相关内容,这个前缀将在 中被使用,也就是在启动节点时会被作为-传入。

info模式

  <!-- Verbose Mode Option --><arg name="info" default="$(arg debug)" /><arg unless="$(arg info)" name="command_args" value="" /><arg     if="$(arg info)" name="command_args" value="--debug" /># Verbose Mode Option:用于设置是否启用详细模式。# 当开启详细模式时,move_group会在console输出更多信息,帮助用户了解move_group中发生的事情# info:用于指示是否启用详细模式的参数,默认与debug参数相同。# 当开启debug时,verbose详细模式也将被默认开启# 如果详细模式开启,则command_args参数值为--debug

在这个案例中,节点启动时将使用参数作为参数传入节点:

info参数在demo.中作为参数被="true"传入到.中作为参数。

  <!-- move_group settings --><arg name="pipeline" default="ompl" /># 机器人运动规划的管道。# MoveIt提供了几种规划算法,例如OMPL、SBPL等。此参数允许用户选择使用哪种算法进行运动规划。默认值为“ompl”。

关于OMPL(Open )算法,可参考OMPL官方文档、OMPL

在这个案例中,参数在demo.中作为参数被="true"传入到.中作为参数。

  <arg name="allow_trajectory_execution" default="true"/># 设置 allow_trajectory_execution 为 true,# 可以让 move_group 在运行过程中尝试让机器人执行这些预定义的轨迹# 但如果该参数设置为 false,则只会规划但不会执行规划的轨迹,机器人将保持静止# 此功能对于测试和调试非常有用,因为它允许操纵轨迹,而无需在机器人上实际执行它们# 它在关注安全的情况下也很有用,因为它提供了一种防止意外执行危险轨迹的方法

在这个案例中,参数在demo.中作为 file="$()/."的arg参数被传入到.中作为参数。

nager

  <arg name="moveit_controller_manager" default="simple" /># moveit_controller_manager:选择控制器管理器的类型,在move_group中默认值为“simple”。# 控制器管理器用于加载和配置机器人的控制器。# MoveIt提供了几种类型的控制器管理器,包括“fake”,“simple”和“ros_control”。

提供的控制器管理器包括以下三种类型:

fake: 这种类型的控制器仅模拟运动,不与真实机器人进行通信。它通常用于快速测试和演示,对于仿真,通常使用fake控制器来模拟运动。

: 这种类型的控制器与机器人进行通信,但仅提供了基本控制,例如直线/圆弧插值等。它适用于一些较简单的机器人。

: 这是一种更灵活的控制器类型,可支持各种机器人和控制器硬件。它提供了更高级别的控制接口,例如电机控制器接口和传感器读取接口。

根据应用场景和机器人的要求,使用不同类型的控制器管理器。

在这个案例中,nager参数在demo.中通过="true"被传入到.中作为参数。

在.中这个参数默认为,而在demo.中为fake,这是因为demo.是单纯用于RViz中测试插件的,通过demo.来启动.时,控制器的类型为fake。

<arg name="fake_execution_type" default="interpolate" /># fake_execution_type:设置虚拟控制器的执行模式。# 如果选择“fake”控制器管理器,则使用虚拟控制器进行模拟运动。# 此参数指定用于虚拟运动的执行模式,包括“interpolate”,“last point。默认值为“interpolate”。

:该选项表示假设控制器将在轨迹的每个目标点之间进行插值。这种方式可以模拟连续的轨迹执行过程。

last point:此选项表示假设控制器将直接跳到轨迹的最后一个目标点。这种方式可以模拟机器人快速执行任务。

在/..xml文件中发现了这两种描述,不确定是否有第三种via 来和官方文档中关于fake 的描述匹配。

但在官方文档中有关于fake 的详细描述,可参考 官方文档

提供了一系列虚拟轨迹控制器,可用于模拟。其中,虚拟控制器的配置文件位于 /.yaml 。

可以根据需要调整以下控制器类型:

虚拟控制器类型信息可在 .yaml 文件中配置。对于每个控制器,都需要指定名称、类型和涉及的关节。其中,频率为 rate: 10,可用于插补控制器。但在对夹爪进行控制时,关节为空列表 []。

示例:

rate: 10
controller_list:- name: fake_arm_controllertype: interpolatejoints:- joint_1- joint_2- joint_3- joint_4- joint_5- joint_6- name: fake_gripper_controllerjoints:[]

  <arg name="max_safe_path_cost" default="1"/># max_safe_path_cost:最大安全路径成本,默认为1。# 作为参数sense_for_plan/max_safe_path_cost的值被传入move_group节点# 这个参数值将影响move_group路径规划的行为。# 目前没有发现该值的使用标准和方式,可以不理会。

参数用于设置移动组()中的最大安全路径成本参数/。这个参数定义了移动组在规划机器人路径时所能接受的最大路径成本。路径成本是基于路径上的障碍物、碰撞风险等因素计算得出的。

当进行路径规划时,会根据给定的目标设置和约束条件尝试找到一条满足安全性要求的路径。如果生成的路径的总成本(代价)超过了参数指定的阈值,那么将认为该路径不是安全的,将停止搜索更多的路径。这有助于避免规划出不安全或代价过高的路径。

较低的最大安全路径成本阈值会导致规划器更加谨慎并更多地考虑避免碰撞和障碍物,因为很容易到达最大的安全成本阈值,变得不安全。

而较高的最大安全路径成本可以帮助增加规划器生成有效路径的能力,因为有更加宽容的安全路径成本范围可供规划器去生成路径。

通过设置参数,可以限制规划器为机器人生成的路径选择最安全的路径。

  <arg name="publish_monitored_planning_scene" default="true"/># 是否发布监视的规划场景,默认为true。

在的.中,用于设置是否发布监视的的规划场景。

如果该参数被设置为true,发布监视的规划场景被启用,它会将当前的规划场景发布到特定的话题,其他节点或工具可以通过订阅该话题以获取最新的规划场景信息,监视的规划场景包含有关机器人、障碍物、规划请求和其他相关信息的实时数据,

当开启时,用户或系统可以实时监视、分析和响应规划场景的变化,从而进行相应的处理,这对于可视化、调试和其他用途非常有用。

的节点会在规划过程中发布监视的规划场景,包括or/ne,or/ates,or/s,or/。

  <arg name="capabilities" default=""/><arg name="disable_capabilities" default=""/># 用于设置运动规划组(move_group)的功能和禁用功能的选项# 无需理会

用于指定在运动规划组中启用的功能。这些功能包括例如允许规划运动轨迹、执行运动轨迹、执行单个运动目标等。可以通过在中设置相应的值来启用特定的功能。

用于禁用运动规划组中的某些功能。通过在中设置功能的值,可以禁用规划组中不需要的功能。这对于限制或简化运动规划组的功能很有用。

这些选项允许根据应用程序的需求灵活地配置和定制的运动规划组的功能。

  <!--Other settings--><arg name="load_gripper" default="true" /># 指定是否加载机器人夹爪的控制器。此参数用于加载和配置夹爪的运动控制器。默认值为true。

在这个案例中,由demo.通过="true"传入.

  <arg name="transmission" default="effort" /># 设置用于关节控制的传输类型。这个参数用来选择传输类型,例如position、velocity或effort。# 默认情况下,这个参数在move_group中被设置为"effort"

在中,是一个参数,用于指定机械臂的传动类型。此参数指定了机械臂控制器()使用的传动系统类型,默认为""(力/扭矩传动)。

传动类型的选择会影响机械臂在中的控制方式。具体的传动类型包括:

如果任务需要施加特定的力或扭矩,可以选择控制方式。

如果任务需要平滑连续的运动,可以选择控制方式。

如果任务需要精确的位置控制,可以选择控制方式

选择合适的传动类型取决于机械臂的具体配置和要求。在配置时,可以根据机械臂的传动系统设置相应的参数,以确保正确的控制信号传递给机械臂。

在这个案例中,由demo.通过="true"传入.,在demo.中该值为空,也就是使用默认的值为

  <arg name="arm_id" default="panda" /># 机器人的标识符。这个参数指定在机器人有多个实现时使用哪一个。# 当多机器人协同时,标识符可以用来区分它们。默认值设置为“panda”

on

  <arg name="load_robot_description" default="true" /># 指定是否加载或覆盖机器人描述及joint_limits文件。MoveIt需要知道机器人的描述才能进行规划和控制。# 这个参数用于加载机器人的URDF文件或覆盖已有的机器人描述。默认值为true。

on将机器人的描述文件(通常为urdf或sdf格式)加载到ROS参数服务器中。如果on参数为true,则会加载或覆盖先前设置的机器人描述文件。如果为false,则使用先前已经加载了的机器人描述文件。

的发布通过r节点来实现。该节点从参数服务器中获取机器人的描述信息,计算机器人每个联动部件的变换,并发布机器人的tf树和关节状态信息。 节点接收tf和关节状态信息,用于运动规划和执行。

在这个案例中,on由demo.通过="true"传入.

URDF/SRDF/配置

  <!-- load URDF, SRDF and joint_limits configuration --><include file="$(dirname)/planning_context.launch"><arg name="load_robot_description" value="$(arg load_robot_description)" /><arg name="load_gripper" value="$(arg load_gripper)" /><arg name="arm_id" value="$(arg arm_id)" /></include>

嵌套的指令会调用.文件,并将on、和参数传递给它。

.文件的作用是加载URDF( Robot )、SRDF( Robot )和关节限制配置 等相关文件,为机器人的运动规划上下文 创建所需的配置和环境。

运动规划管道

 <!-- Planning Pipelines --><group ns="move_group/planning_pipelines"><!-- OMPL --><include file="$(dirname)/planning_pipeline.launch.xml"><arg name="pipeline" value="ompl" /><arg name="arm_id" value="$(arg arm_id)" /></include><!-- CHOMP --><include file="$(dirname)/planning_pipeline.launch.xml"><arg name="pipeline" value="chomp" /><arg name="arm_id" value="$(arg arm_id)" /></include><!-- Pilz Industrial Motion --><include file="$(dirname)/planning_pipeline.launch.xml"><arg name="pipeline" value="pilz_industrial_motion_planner" /><arg name="arm_id" value="$(arg arm_id)" /></include><!-- Support custom planning pipeline --><include if="$(eval arg('pipeline') not in ['ompl', 'chomp', 'pilz_industrial_motion_planner'])"file="$(dirname)/planning_pipeline.launch.xml"><arg name="pipeline" value="$(arg pipeline)" /><arg name="arm_id" value="$(arg arm_id)" /></include></group># 启动OMPL规划器# 启动CHOMP规划器# 启动Pilz Industrial Motion规划器# 当还有其他自定义的pipeline时,再启动自定义规划器# 自定义规划器的文件为 planning_pipeline.launch.xml# 启动的规划器包括预定义的规划器(OMPL、CHOMP和Pilz Industrial Motion)以及自定义规划器

网狐6603架设教程详细_软路由ros详细教程_

同时加载多个规划器的原因

同时启动这三个规划器的目的是为了提供多种选择和灵活性,以适应不同的运动规划需求和算法偏好。每个规划器都有其独特的算法和特点,可以在不同的场景下产生较好的规划结果。

尽管这三个规划器都被加载,但在实际使用过程中,通常只会选择其中一个规划器进行规划任务。

这是因为节点启动时,会选择默认的规划器,这个默认的规划器即是用户传入的参数,只有与其值匹配的规划器才会真正执行规划任务。

 <param name="default_planning_pipeline" value="$(arg pipeline)" />

因此,只有其中一个规划器会被激活,不会发生冲突。通过在配置文件中选择合适的规划器,并将对应的参数设置为相应的值,可以确保只有需要的规划器被启动和使用。

这种设计让用户能够灵活选择和切换规划器,以满足其特定的需求和实际情况。

同时,对于GUI控制,通过在RViz的插件中的部分可以切换规划。

轨迹执行器

  <!-- Trajectory Execution Functionality --><include ns="move_group" file="$(dirname)/trajectory_execution.launch.xml" pass_all_args="true" if="$(arg allow_trajectory_execution)"><arg name="moveit_manage_controllers" value="true" /></include># 当allow_trajectory_execution=true时,也就是允许轨迹执行时# 启动trajectory_execution.launch.xml文件# 这个文件负责运行MoveIt的轨迹执行功能# 将moveit_manage_controllers参数设置为`true`表示由MoveIt来管理控制器

文件..xml用于配置的轨迹执行器。而llers参数用于控制对底层机器人控制器的管理方式。

具体来说,

当llers="true"意味着将管理整个机器人控制系统(包括底层的控制器),并负责确保控制器在需要时启动,并在不需要时关闭。这是最常用的设置,尤其是在使用单一机器人控制器的情况下。

当llers="false"表示不负责底层机器人控制器的启管理工作。这意味着用户需要自行处理底层控制器的管理。这种设置适用于那些已经具有独立的控制器管理系统的用户,或者在使用多个独立控制器的复杂机器人系统中。

通过配置llers参数,可以根据实际情况选择是让管理机器人控制器,还是由用户自行管理。

传感器管理器

  <!-- Sensors Functionality --><include ns="move_group" file="$(dirname)/sensor_manager.launch.xml" if="$(arg allow_trajectory_execution)"><arg name="moveit_sensor_manager" value="panda" /></include># 用于管理各个传感器# 当允许轨迹控制时才启动传感器管理器# 参数moveit_sensor_manager的作用是指定要使用的传感器管理器的名称或标识符# 该参数的值用于告知MoveIt系统应该使用哪个传感器管理器来处理与传感器设备的交互

r

传感器管理器r是中一个负责与传感器设备通信和数据处理的组件。不同的传感器设备可能需要不同的传感器管理器来处理其数据格式、通信接口等特定要求。通过r,可以灵活地配置和切换传感器管理器,以适应不同的传感器设备或需求。

为真的情况下,才需要加载传感器管理器。

这是因为轨迹执行阶段需要使用传感器数据来监测和调整实际的运动执行过程。

如果不执行轨迹,或者不需要基于传感器数据进行实时监测和调整,那么加载传感器管理器可能是不必要的,因此使用作为启动条件可以根据需要有选择地加载和使用传感器管理器。

..xml

..xml的作用是管理中的传感器,它用于配置和启动与相关的传感器设备。这可能包括类似深度相机、激光扫描仪或其他传感器设备。该文件定义了传感器设备的参数,例如传感器的类型、发布的话题以及相关的参数设置。

在.中调用..xml的目的是允许系统与传感器设备进行交互,以便在运动规划和执行过程中获取感知数据。通过将传感器启动文件包含到.中,节点可以与传感器节点进行通信,并使用传感器数据对运动规划和执行进行增强或调整。

节点

  <!-- Start the actual move_group node/action server --><node name="move_group" launch-prefix="$(arg launch_prefix)" pkg="moveit_ros_move_group" type="move_group" respawn="false" output="screen" args="$(arg command_args)"># 根据GDB调试器开关的参数作为launch-prefix# launch-prefix用于指定在启动节点时添加的前缀命令。这通常用于设置环境变量或传递特定的命令行参数# 运行moveit_ros_move_group包中的move_group文件# respawn指定节点是否在结束后重新启动。在这里设置为"false",意味着节点在结束后不会重新启动。# output指定输出打印到屏幕上,也就是终端窗口里# args="$(arg command_args)"用于传递额外的命令行参数给节点。# 此处的command_args参数值是--debug# 意味着当debug模式开启时会提供详细信息输出模式

X 服务器

X服务器(X )是一个用于图形显示的软件服务,它是在Linux和Unix系统中实现图形用户界面(GUI)的基本组件之一。X服务器管理图形显示设备(如显示器、键盘、鼠标等),接收用户输入并将图形界面渲染到显示器上。

在现代的Linux系统中,常用的X服务器实现是X.Org ,

系统所使用的是 - X

X 由客户端和服务端组成,服务端X 负责图形显示,而客户端库X 根据系统设置的环境变量,将图形显示请求发送给相应的X 。

只需要在远端开启一个X ,并在目标机器上相应的设置变量,即可完成图形的远程显示。

常见的应用情景是:

ssh -X username@ubuntu-server-ip

在使用ssh -X时,通过 Shell(SSH)进行 X11转发,用户可以在远程服务器上运行图形界面程序,并将其显示到本地计算机上,而无需在本地安装图形界面软件。

这意味着用户可以通过SSH 连接到机器人上进行远程服务器管理,同时在本地计算机上查看和操作远程的图形界面程序,图形界面将通过SSH隧道和X11转发显示在使用的主计算机上。

    <!-- Set the display variable, in case OpenGL code is used internally --><env name="DISPLAY" value="$(optenv DISPLAY :0)" />

在ROS中,用于控制机器人的软件通常是在高级计算机上运行的,而不是边缘端,通常图像并不在边缘端显示。

当涉及到在图形界面上显示或操作时(例如可视化机器人模型、运动规划的可视化结果等),通常会使用库进行绘图操作。

设置环境变量是为了确保节点内部的代码能够正确地显示图形界面。环境变量指定了X 的地址,它告诉程序在哪里显示图形界面。

是ROS 文件中用来设置环境变量的标签。

是ROS 文件中的一个函数,用于从系统环境变量中获取值并提供默认值。

在Linux系统中(例如),环境变量指示了X 的位置,它的格式通常是:.。对于本地X ,一般使用:0来表示默认的第一个显示屏。

$( :0)表示从系统环境变量中获取的值,如果没有找到则使用默认值:0。

在这段代码中,通过标签将环境变量设置为$( :0)。

这样一来,当节点需要在图形界面上显示结果时,它会使用设置好的环境变量来与X服务器进行通信,以确保代码能够正确地渲染和显示图形界面。这样用户就可以通过图形界面来查看和操作机器人的运动规划结果。

的其他参数

    <param name="allow_trajectory_execution" value="$(arg allow_trajectory_execution)"/><param name="sense_for_plan/max_safe_path_cost" value="$(arg max_safe_path_cost)"/><param name="default_planning_pipeline" value="$(arg pipeline)" /><param name="capabilities" value="$(arg capabilities)" /><param name="disable_capabilities" value="$(arg disable_capabilities)" /># 以下为传入move_group节点的参数,他们在此前被介绍过# allow_trajectory_execution 允许轨迹执行# sense_for_plan/max_safe_path_cost 最大安全路径代价值# default_planning_pipeline 默认的规划流水线# capabilities 功能 无需理会# disable_capabilities 禁止功能 无需理会

发布实际机器人的规划场景的参数

    <!-- Publish the planning scene of the physical robot so that rviz plugin can know actual robot --><param name="planning_scene_monitor/publish_planning_scene" value="$(arg publish_monitored_planning_scene)" /><param name="planning_scene_monitor/publish_geometry_updates" value="$(arg publish_monitored_planning_scene)" /><param name="planning_scene_monitor/publish_state_updates" value="$(arg publish_monitored_planning_scene)" /><param name="planning_scene_monitor/publish_transforms_updates" value="$(arg publish_monitored_planning_scene)" /></node>

节点通过发布实际机器人的规划场景,使得RViz能够了解实际机器人的规划场景,需要传入节点的参数包括以下,这些参数将控制对应的话题的发布:

or/ne参数用于发布当前规划场景的信息。它将当前的规划场景以消息的形式发布出去,允许其他节点(如可视化工具或运动规划器)订阅并获取当前的规划场景信息。这样可以实时地将最新的场景信息传递给其他节点,以便它们做出相应的决策。

or/ates参数,用于发布物体几何信息的更新。当物体的几何形状发生变化(例如对象被添加、移除、形状发生变化),该话题将更新的几何信息发布出去。这样其他节点可以根据几何更新来调整规划场景,使其保持最新状态。

or/s参数,用于发布运动状态的更新。当机器人的状态发生变化(例如关节位置修改,联动状态更新),该话题将机器人的状态信息发布出去。其他节点可以订阅该话题以获取最新的机器人状态信息,以便做出相应的决策。

or/参数,用于发布坐标变换的更新。当与机器人相关的坐标变换发生改变时,该话题将变换的更新信息发布出去。其他节点可以订阅该话题以获取最新的坐标变换信息,以便在规划和执行过程中使用正确的坐标变换。

这些参数对应开启关闭的话题的使用可以实现实时的场景更新和状态反馈,使得不同节点之间可以共享和协调规划场景信息,提供更有效的运动规划和执行能力。

切片解析4: .

.文件的作用是加载机器人描述URDF( Robot )、语义描述SRDF( Robot )和关节限制配置、笛卡尔限制、运动学设置等相关文件,为机器人的运动规划安排好所需的配置和环境。

.文件在.中被作为嵌套的文件调用,并从.中获取了参数on,和。

完整的代码如下:

<launch><!-- By default we do not overwrite the URDF. Change the following to true to change the default behavior --><arg name="load_gripper" default="true" /><arg name="load_robot_description" default="false"/><arg name="arm_id" default="panda" /><!-- The name of the parameter under which the URDF is loaded --><arg name="robot_description" default="robot_description"/><!-- Load universal robot description format (URDF) --><param name="$(arg robot_description)" command="xacro '$(find franka_description)/robots/panda/panda.urdf.xacro' hand:=$(arg load_gripper) arm_id:=$(arg arm_id)" if="$(arg load_robot_description)" /><!-- The semantic description that corresponds to the URDF --><param name="$(arg robot_description)_semantic" command="xacro '$(find panda_moveit_config)/config/panda.srdf.xacro' hand:=$(arg load_gripper) arm_id:=$(arg arm_id)" /><!-- Load updated joint limits (override information from URDF) --><group ns="$(arg robot_description)_planning"><rosparam command="load" file="$(find panda_moveit_config)/config/joint_limits.yaml" subst_value="true" /><rosparam command="load" file="$(find panda_moveit_config)/config/cartesian_limits.yaml" subst_value="true"/></group><!-- Load default settings for kinematics; these settings are overridden by settings in a node's namespace --><group ns="$(arg robot_description)_kinematics"><rosparam command="load" file="$(find panda_moveit_config)/config/kinematics.yaml" subst_value="true"/></group></launch>

传入参数

  <!-- By default we do not overwrite the URDF. Change the following to true to change the default behavior --><arg name="load_gripper" default="true" /><arg name="load_robot_description" default="false"/><arg name="arm_id" default="panda" /># 是否加载夹爪# 是否加载URDF模型# 机械臂的id,用作识别机器人的标识

载入模型

    <!-- The name of the parameter under which the URDF is loaded --><arg name="robot_description" default="robot_description"/># robot_description参数用于存储加载的机器人的URDF描述对应的参数名,无需理会

  <!-- Load universal robot description format (URDF) --><param name="$(arg robot_description)" command="xacro '$(find franka_description)/robots/panda/panda.urdf.xacro' hand:=$(arg load_gripper) arm_id:=$(arg arm_id)" if="$(arg load_robot_description)" />
# 将URDF文件加载为ROS参数
# 这个URDF文件是由xacro命令从panda.urdf.xacro文件来生成的
# 之前引入的hand和arm_id被传给xacro命令作为参数

如果使用一键安装配置脚本安装了,则可以在/opt/ros//share///panda目录下找到panda.urdf.xacro

xacro是一个XML宏语言。在这个情况下,xacro被用来处理URDF( Robot )文件,使得URDF文件更加模块化和易于管理。

hand:=$(arg ) 和 :=$(arg )将会被传入指定的xacro文件中,这些参数在xacro文件中被用来根据需求生成特定的URDF配置。

panda.urdf.xacro


# XML的版本和编码声明。所有的XML文件都会以这个声明开始
<robot xmlns:xacro="http://www.ros.org/wiki/xacro" name="panda">
# 定义一个名为“panda”的机器人。xmlns:xacro指定了xacro命名空间的URL<xacro:include filename="$(find franka_description)/robots/common/franka_robot.xacro"/>
# 引入另一个xacro文件,路径是通过find指令找到的
# 这是一种模块化设计,允许将机器人模型分割为更小、更易于管理的部分<xacro:arg name="arm_id" default="panda" />
# 定义参数名为"arm_id",并设置其默认值为"panda",如果有外部值传入,则为外部传入的值<xacro:franka_robot arm_id="$(arg arm_id)"joint_limits="${xacro.load_yaml('$(find franka_description)/robots/panda/joint_limits.yaml')}">
# 调用franka_robot.xacro宏,并将参数arm_id和joint_limits传入xacro:franka_robot>robot>

.xacro

在panda.urdf.xacro所包含的.xacro中,对于hand的调用有判断如下:

    <xacro:if value="$(arg hand)"><xacro:include filename="$(find franka_description)/robots/common/franka_hand.xacro"/><xacro:franka_handarm_id="$(arg arm_id)"rpy="0 0 ${-pi/4}"tcp_xyz="$(arg tcp_xyz)"tcp_rpy="$(arg tcp_rpy)"connected_to="$(arg arm_id)_link8"safety_distance="0.03"gazebo="$(arg gazebo)"/></xacro:if>

因此,hand:=$(arg ) 和 :=$(arg )将会被传入指定的xacro文件中,用作判断是否需要加载夹爪以及设置。

载入SRDF

    <!-- The semantic description that corresponds to the URDF --><param name="$(arg robot_description)_semantic" command="xacro '$(find panda_moveit_config)/config/panda.srdf.xacro' hand:=$(arg load_gripper) arm_id:=$(arg arm_id)" />
# 加载SRDF (Semantic Robot Description Format) 文件到ROS参数服务器

SRDF文件通常包含了关于机器人的高级信息,在的案例中,它由生成,包含例如组、链等内容。SRDF文件也是由xacro命令从xacro宏转化的。

关节限位和笛卡尔限制

用于覆盖URDF中的相关限位信息

    <!-- Load updated joint limits (override information from URDF) --><group ns="$(arg robot_description)_planning"><rosparam command="load" file="$(find panda_moveit_config)/config/joint_limits.yaml" subst_value="true" /><rosparam command="load" file="$(find panda_moveit_config)/config/cartesian_limits.yaml" subst_value="true"/></group>
# 加载限位数据到ROS参数服务器的robot_description_planning参数

运动学相关设置

    <!-- Load default settings for kinematics; these settings are overridden by settings in a node's namespace --><group ns="$(arg robot_description)_kinematics"><rosparam command="load" file="$(find panda_moveit_config)/config/kinematics.yaml" subst_value="true"/></group>
# 加载运动学相关参数到ROS参数服务器的robot_description_kinematics参数    

切片解析5:..xml

这个文件在.中关于的部分被调用,它用于调用对应的

..xml,例如ne..xml。

在.,它调用了四个,包括ompl、 chomp、、自定义、可以将它视作各种调用的统一的接口,以下是这个文件的内容:

<launch><!-- This file makes it easy to include different planning pipelines;It is assumed that all planning pipelines are named XXX_planning_pipeline.launch  --><arg name="pipeline" default="ompl" /><arg name="arm_id" default="panda" /><include ns="$(arg pipeline)" file="$(dirname)/$(arg pipeline)_planning_pipeline.launch.xml" pass_all_args="true"/></launch>

例如,当传入的参数为ompl时,启动对应的ne..xml文件,这使得不同规划库的..xml易于管理,通过..xml来专门进行调用。

切片解析6: ne..xml

<launch><arg name="planning_adapters"default="default_planner_request_adapters/AddTimeParameterizationdefault_planner_request_adapters/ResolveConstraintFramesdefault_planner_request_adapters/FixWorkspaceBoundsdefault_planner_request_adapters/FixStartStateBoundsdefault_planner_request_adapters/FixStartStateCollisiondefault_planner_request_adapters/FixStartStatePathConstraints"/><arg name="start_state_max_bounds_error" default="0.1" /><arg name="jiggle_fraction" default="0.05" /><arg name="arm_id" default="panda" /><param name="planning_plugin" value="ompl_interface/OMPLPlanner" /><param name="request_adapters" value="$(arg planning_adapters)" /><param name="start_state_max_bounds_error" value="$(arg start_state_max_bounds_error)" /><param name="jiggle_fraction" value="$(arg jiggle_fraction)" /><rosparam command="load" file="$(find panda_moveit_config)/config/ompl_planning.yaml" subst_value="true"/>launch>

规划适配器插件

    <!-- The request adapters (plugins) used when planning with OMPL. ORDER MATTERS! --><arg name="planning_adapters"default="default_planner_request_adapters/AddTimeParameterizationdefault_planner_request_adapters/ResolveConstraintFramesdefault_planner_request_adapters/FixWorkspaceBoundsdefault_planner_request_adapters/FixStartStateBoundsdefault_planner_request_adapters/FixStartStateCollisiondefault_planner_request_adapters/FixStartStatePathConstraints"/>

定义了一个名为的参数,并为其设置了默认值。此默认值是一个列表。

在中,规划适配器( ) 是指一种特定的插件,用于在规划请求发送到规划器之前和规划器生成路径后修改规划请求和规划响应。

在上述代码中,参数包含了六个默认的适配器,它们分别负责处理不同类型的问题。例如,ion用于给规划的轨迹添加时间参数,这是因为大多数规划器只关心空间,而不关心时间。

其他适配器例如,,on,和mes等,分别用于修正工作空间边界,修正开始状态边界,修正开始状态碰撞,修正开始状态路径约束以及解决约束帧问题。

其他参数

<arg name="start_state_max_bounds_error" default="0.1" />
# 机器人开始状态的最大边界错误
# 默认值被设置为0.1

在运动规划的过程中,机器人的当前状态是其开始状态。

由于传感器的误差和其他的不确定性因素,这个开始状态可能与机器人的实际状态存在一些差距。这个参数就是用来限制这个差距的,如果超过这个值,就会尝试修复开始状态,使其满足这个边界误差要求。

<arg name="jiggle_fraction" default="0.05" />
# 开始状态调整时所允许的最大变化幅度
# 默认值被设置为0.05

这个参数在修复开始状态时非常重要。

如果由于某些原因,机器人的开始状态不能满足运动规划的要求(例如,机器人的开始状态在一个碰撞状态),会尝试微调(“”)机器人的关节,使得机器人的开始状态满足规划的要求。

这个参数表示这个微调过程中,每个关节所允许的最大变化幅度,以关节的运动范围的百分比表示。

例如,如果设为0.01,那么在微调过程中,每个关节的角度都只能在其运动范围的1%以内变化。

<arg name="arm_id" default="panda" />
# 机械臂id,用于指定运动规划所涉及的机器臂

载入到ROS参数服务器的参数

<param name="planning_plugin" value="ompl_interface/OMPLPlanner" />
# 设置ROS参数planning_plugin的值为ompl_interface/OMPLPlanner
# 这表示运动规划将使用OMPL库进行

<param name="request_adapters" value="$(arg planning_adapters)" />
<param name="start_state_max_bounds_error" value="$(arg start_state_max_bounds_error)" />
<param name="jiggle_fraction" value="$(arg jiggle_fraction)" />
# 将之前设置的arg参数值作为值填入这几个ROS参数服务器的参数

<rosparam command="load" file="$(find panda_moveit_config)/config/ompl_planning.yaml" subst_value="true"/>
# 加载ompl_planning.yaml文件
# 该文件包含了用于OMPL运动规划库的具体参数配置

切片解析7: ..xml

..xml配置了运动轨迹执行的一些参数

<launch><arg name="moveit_controller_manager" /><arg name="fake_execution_type" default="interpolate" /><arg name="moveit_manage_controllers" default="true"/><param name="moveit_manage_controllers" value="$(arg moveit_manage_controllers)"/><param name="trajectory_execution/allowed_execution_duration_scaling" value="1.2"/> <param name="trajectory_execution/allowed_goal_duration_margin" value="0.5"/> <param name="trajectory_execution/allowed_start_tolerance" value="0.01"/> <include file="$(dirname)/$(arg moveit_controller_manager)_moveit_controller_manager.launch.xml" pass_all_args="true" />launch>

控制器管理者

    <!-- Define moveit controller manager plugin: fake, simple, or ros_control -->
<arg name="moveit_controller_manager" />
# moveit_controller_manager参数用于指定MoveIt!控制器管理器插件的名称
# 可选的值为:fake, simple, or ros_control

提供的控制器管理器包括以下三种类型:

fake: 这种类型的控制器仅模拟运动,不与真实机器人进行通信。它通常用于快速测试和演示,对于仿真,通常使用fake控制器来模拟运动。

: 这种类型的控制器与机器人进行通信,但仅提供了基本控制,例如直线/圆弧插值等。它适用于一些较简单的机器人。

: 这是一种更灵活的控制器类型,可支持各种机器人和控制器硬件。它提供了更高级别的控制接口,例如电机控制器接口和传感器读取接口。

根据应用场景和机器人的要求,使用不同类型的控制器管理器。

是机器人强大的控制器,可参考 WIKI文档和源代码

虚拟控制器执行方式

<arg name="fake_execution_type" default="interpolate" /># fake_execution_type:设置虚拟控制器的执行模式。# 如果选择“fake”控制器管理器,则使用虚拟控制器进行模拟运动。# 此参数指定用于虚拟运动的执行模式,包括“interpolate”,“last point。默认值为“interpolate”。

:该选项表示假设控制器将在轨迹的每个目标点之间进行插值。这种方式可以模拟连续的轨迹执行过程。

last point:此选项表示假设控制器将直接跳到轨迹的最后一个目标点。这种方式可以模拟机器人快速执行任务。

在/..xml文件中发现了这两种描述,不确定是否有第三种via 来和官方文档中关于fake 的描述匹配。

但在官方文档中有关于fake 的详细描述,可参考 官方文档

提供了一系列虚拟轨迹控制器,可用于模拟。其中,虚拟控制器的配置文件位于 /.yaml 。

可以根据需要调整以下控制器类型:

虚拟控制器类型信息可在 .yaml 文件中配置。对于每个控制器,都需要指定名称、类型和涉及的关节。其中,频率为 rate: 10,可用于插补控制器。但在对夹爪进行控制时,关节为空列表 []。

示例:

rate: 10
controller_list:- name: fake_arm_controllertype: interpolatejoints:- joint_1- joint_2- joint_3- joint_4- joint_5- joint_6- name: fake_gripper_controllerjoints:[]

控制器们的管理权限

    <!-- Flag indicating whether MoveIt is allowed to load/unload  or switch controllers --><arg name="moveit_manage_controllers" default="true"/><param name="moveit_manage_controllers" value="$(arg moveit_manage_controllers)"/>

在.中llers参数被设置为true,表示由来管理控制器。

该参数随后传递到..xml,定义了一个参数并将其设置为一个ROS参数,参数名为llers,默认值为"true"。

当该参数为"true"时,将有权限来加载/卸载或者切换控制器。

不同的任务或不同阶段的任务可能需要使用不同的控制器。例如,一种控制器可能用于精确位置控制,而另一种可能用于力控制。通过动态切换控制器,!可以更好地适应不同的任务需求。

因此,当运行在真实机器人或者使用了的仿真器上时,通常需要这个选项。

轨迹执行的限制参数

<!-- When determining the expected duration of a trajectory, this multiplicative factor is applied to get the allowed duration of execution -->
<param name="trajectory_execution/allowed_execution_duration_scaling" value="1.2"/> <!-- default 1.2 -->

参数是允许的运动轨迹执行时间的缩放因子,默认值是1.2。这个参数用于在计算运动轨迹的期望时间时,会乘上这个缩放因子,得出允许的执行时间。

<!-- Allow more than the expected execution time before triggering a trajectory cancel (applied after scaling) -->
<param name="trajectory_execution/allowed_goal_duration_margin" value="0.5"/> <!-- default 0.5 -->

参数是允许的运动轨迹执行时间的容忍范围,默认值是0.5秒。如果轨迹执行时间超出了期望时间加上这个容忍范围,那么就会触发取消轨迹的操作。

<!-- Allowed joint-value tolerance for validation that trajectory's first point matches current robot state -->
<param name="trajectory_execution/allowed_start_tolerance" value="0.01"/> <!-- default 0.01 -->

nce参数是允许的运动轨迹起始点的关节值容忍范围,默认值是0.1。!会检查轨迹的起始点是否与当前机器人的状态相符,如果差异超过这个容忍范围,那么就会认为轨迹不合法。

控制器管理器启动文件的调用

    <!-- We use pass_all_args=true here to pass fake_execution_type, which is required by fake controllers, but not by real-robot controllers.As real-robot controller_manager.launch files shouldn't be required to define this argument, we use the trick of passing all args. --><include file="$(dirname)/$(arg moveit_controller_manager)_moveit_controller_manager.launch.xml" pass_all_args="true" />

nager在demo.中指定为fake,经由="true"传递给.,覆盖掉了.中默认的nager参数值,随后由.通过="true"传递给..xml,在..xml中用来选择该参数指定的的控制器类型。

比如nager参数为fake,就会调用..xml文件。

切片解析8: ..xml

..xml在..xml中被调用,原因是nager参数为fake,所以..xml在三个控制器管理者(fake, , )中被选取了。

它用于启动一个仿真控制器。

<launch><!-- execute the trajectory in 'interpolate' mode or jump to goal position in 'last point' mode --><arg name="fake_execution_type" default="interpolate" /><!-- Set the param that trajectory_execution_manager needs to find the controller plugin --><param name="moveit_controller_manager" value="moveit_fake_controller_manager/MoveItFakeControllerManager"/><!-- The rest of the params are specific to this plugin --><rosparam subst_value="true" file="$(find panda_moveit_config)/config/fake_controllers.yaml"/></launch>

="true"的作用是对 文件中的路径进行替换。当 设置为 true 时, 文件会在加载参数文件之前对其路径中的 $(find ) 进行替换,将其替换为实际的 ROS 包路径。

默认情况下,如果没有提供 属性, 元素将执行 ="load" 的操作

虚拟控制器执行方式

    <!-- execute the trajectory in 'interpolate' mode or jump to goal position in 'last point' mode --><arg name="fake_execution_type" default="interpolate" />
# fake_execution_type参数的值决定了执行轨迹的方式
# "interpolate"表示在模拟环境中,机器人会执行完整的轨迹
# 如果值设置为"last point",那么机器人将直接跳到目标位置。

ROS参数服务器的控制器管理者参数

    <!-- Set the param that trajectory_execution_manager needs to find the controller plugin --><param name="moveit_controller_manager" value="moveit_fake_controller_manager/MoveItFakeControllerManager"/>
# 设置ROS参数moveit_controller_manager
# 值为moveit_fake_controller_manager/MoveItFakeControllerManager
# 这个参数是用于指定控制器管理器的插件名称,这里使用的是MoveIt提供的虚拟控制器

加载.yaml到参数服务器

    <!-- The rest of the params are specific to this plugin --><rosparam subst_value="true" file="$(find panda_moveit_config)/config/fake_controllers.yaml"/>
# 加载了/config/fake_controllers.yaml配置文件
# 这个YAML文件包含了模拟控制器的配置信息

="true"的作用是对 文件中的路径进行替换。当 设置为 true 时, 文件会在加载参数文件之前对其路径中的 $(find ) 进行替换,将其替换为实际的 ROS 包路径。

默认情况下,如果没有提供 属性, 元素将执行 ="load" 的操作

/.yaml

controller_list:- name: fake_$(arg arm_id)_arm_controllertype: $(arg fake_execution_type)joints:- $(arg arm_id)_joint1- $(arg arm_id)_joint2- $(arg arm_id)_joint3- $(arg arm_id)_joint4- $(arg arm_id)_joint5- $(arg arm_id)_joint6- $(arg arm_id)_joint7- name: fake_$(arg arm_id)_hand_controllertype: $(arg fake_execution_type)joints:- $(arg arm_id)_finger_joint1initial:  # Define initial robot poses per group- group: $(arg arm_id)_armpose: ready- group: $(arg arm_id)_handpose: open

.yaml文件定义了一些虚拟控制器和初始机器人姿态,用于ROS 中的运动规划和控制。

:这是一个控制器列表,其中定义了两个虚拟控制器,分别是fake_$(arg )和fake_$(arg )。这些控制器用于模拟机器人的运动控制。

:这是一个初始机器人姿态的列表,定义了机器人的起始状态。在这个例子中,定义了两个初始姿态,分别是$(arg )_arm和$(arg )_hand。

这个文件的具体内容是根据实际参数值动态生成的,参数的值取决于运行时的配置。通过使用这些虚拟控制器和初始姿态,可以在ROS 中模拟和控制具有不同关节和组的机器人。

切片解析9: ..xml

这个启动文件负责初始化传感器管理器,包括加载传感器类型,设定参数,设定传感器的最大探测距离,并包含特定机器人(Panda)的传感器管理器的启动文件

<launch><!-- This file makes it easy to include the settings for sensor managers --><!-- Params for 3D sensors config: '' | pointcloud | depthmap --><arg name="sensor_type" default="" /><rosparam if="$(eval arg('sensor_type')  != '')" command="load" file="$(find panda_moveit_config)/config/sensors_kinect_$(arg sensor_type).yaml" /><!-- Params for the octomap monitor --><!--  <param name="octomap_frame" type="string" value="some frame in which the robot moves" /> --><param name="octomap_frame" type="string" value="camera_rgb_optical_frame" /><param name="octomap_resolution" type="double" value="0.025" /><param name="max_range" type="double" value="5.0" /><!-- Load the robot specific sensor manager; this sets the moveit_sensor_manager ROS parameter --><arg name="moveit_sensor_manager" default="panda" /><include file="$(dirname)/$(arg moveit_sensor_manager)_moveit_sensor_manager.launch.xml" /></launch>

加载传感器到ROS参数服务器

    <!-- Params for 3D sensors config: '' | pointcloud | depthmap --><arg name="sensor_type" default="" /><rosparam if="$(eval arg('sensor_type')  != '')" command="load" file="$(find panda_moveit_config)/config/sensors_kinect_$(arg sensor_type).yaml" />
# 通过设置"sensor_type"的参数来设定使用的传感器类型
# 支持的传感器类型为depthmap、空和pointcloud
# 其默认值为空
# 如果默认值不为空将载入对应的sensors_kinect_$(arg sensor_type).yaml到ROS参数服务器

/map.yaml

以调用map.yaml为例

sensors:- sensor_plugin: occupancy_map_monitor/DepthImageOctomapUpdaterimage_topic: /camera/depth_registered/image_rawqueue_size: 5near_clipping_plane_distance: 0.3far_clipping_plane_distance: 5.0shadow_threshold: 0.2padding_scale: 4.0padding_offset: 0.03max_update_rate: 1.0filtered_cloud_topic: filtered_cloudns: kinect

YAML 是一种可读性高、适用于配置文件、交换数据、定义语言或序列化对象等场景的数据序列化格式。它的语法设计得易于阅读和编写。

在YAML中,缩进必须使用空格,不能使用制表符。同一层级的元素必须有相同的缩进。

这个YAML文件是用于配置Panda机械臂在ROS 中使用的深度图像传感器。

: r/ater

这一行指定了处理传感器数据的插件。在这里使用r/ater插件来更新。是一种3D网格地图,由占用的、空闲的和未知的单元格构成,用于机器人的环境感知和导航。

: ///

这一行定义了深度图像的话题名。话题是ROS中实现消息传递的方式,订阅///话题以接收深度图像。

: 5

这一行设定了消息队列的大小。在这里,如果有5条消息正在等待处理,那么来自///的新消息将被丢弃。

: 0.3

这一行设定了近剪裁面距离,这是深度图像有效区域的最近边界。小于这个距离的数据会被忽略。

: 5.0

这一行设定了远剪裁面距离,这是深度图像有效区域的最远边界。大于这个距离的数据会被忽略。

: 0.2

这一行设定了阴影阈值。这个值用来判断一个像素是否在另一个像素的阴影中。阈值越小,检测到的阴影越多。

: 4.0 and : 0.03

这两行设定了对深度图像的填充。填充是一种处理方法,用于增加物体周围的空间,以避免机器人与物体的碰撞。

: 1.0

这一行设定了最大更新率。在这里,深度图像的处理速度被限制为每秒最多一次。

:

这一行定义了过滤后的点云数据的话题名。经过处理的深度图像会被转换为点云,并发布到这个话题。

ns:

这一行设定了命名空间(),在这里是。命名空间用于ROS话题、服务等的组织,使得它们能够在复杂系统中更容易地被管理和定位。

总的来说,这个YAML文件定义了深度图像传感器的一些关键配置,使得可以正确地处理和使用深度图像数据。

/cloud.yaml

sensors:- sensor_plugin: occupancy_map_monitor/PointCloudOctomapUpdaterpoint_cloud_topic: /camera/depth_registered/pointsmax_range: 5.0point_subsample: 1padding_offset: 0.1padding_scale: 1.0max_update_rate: 1.0filtered_cloud_topic: filtered_cloudns: kinect

这个YAML文件是用于配置ROS 的点云传感器,特别是对设备的配置。下面是这些参数的详细解释:

: r/ater

这一行指定了处理传感器数据的插件。在这里使用r/ater插件来根据点云数据更新。是一种3D网格地图,用于机器人的环境感知和导航。

: ///

这一行定义了点云数据的话题名。话题是ROS中实现消息传递的方式,这里订阅///话题以接收点云数据。

: 5.0

_网狐6603架设教程详细_软路由ros详细教程

这一行设定了传感器的最大探测距离,值为5.0,单位也通常是米。超过这个距离的物体不会被传感器检测到。

: 1

这一行设定了点云的采样率。此处设置为1,表示每个点都会被采样。如果设置为比1大的值,例如10,那么每10个点只有一个点会被采样。

: 0.1 and : 1.0

这两行设定了对点云的填充。填充是一种处理方法,用于增加物体周围的空间,以避免机器人与物体的碰撞。

: 1.0

这一行设定了最大更新率。在这里,点云的处理速度被限制为每秒最多一次。

:

这一行定义了过滤后的点云数据的话题名。经过处理的点云数据会被发布到这个话题。

点云和深度图的区别

深度图像和点云都是描述三维空间中的物体的数据结构,深度相机可以生成深度图像和点云两种数据,但深度图像和点云的处理方法和用途有所不同,选择哪种数据结构取决于你的具体需求。

深度图像是一个二维数组,每个元素的值代表该像素点到相机的距离。深度图像是由深度相机,如或Intel 等设备,通过测量每个像素点的深度信息生成的。它为每个像素提供一个单一的深度值,这些值共同构成一个深度图。深度图的优点是数据结构简单,易于处理和存储,但是对于某些复杂的3D空间表达可能不够精确。

图源于

点云则是一个在三维空间中分布的点的集合,每个点包含其空间坐标(X,Y,Z)。点云通常通过激光雷达(LiDAR)或者深度相机生成。与深度图像相比,点云更直接地表示了三维空间的结构,能够更好地处理复杂的三维几何问题,但是数据量大,处理复杂度高。

图源自

根据机器人系统的硬件配置和任务需求,可能会选择使用深度图像或者点云。如果系统中有深度相机,并且任务要求处理速度快,数据量小,那么可能更适合使用深度图像。应该使用/map.yaml配置文件。

如果系统中有激光雷达或者需要精确的三维空间表示,那么点云可能是更好的选择。应该使用/cloud.yaml配置文件。

    <!-- Params for the octomap monitor --><!--  <param name="octomap_frame" type="string" value="some frame in which the robot moves" /> --><param name="octomap_frame" type="string" value="camera_rgb_optical_frame" />
# 定义了Octomap的参考坐标系。Octomap是一种用于机器人3D感知的数据结构
# 这里将它的参考坐标系设为了"camera_rgb_optical_frame"
# 这个参考坐标系通常是由RGB相机提供的

每一个传感器读取或机器人运动的数据都必须关联到一个特定的参考坐标系。

这些Frame连接在一起形成了一个 tree,它是机器人在现实世界中感知自我位置和外部环境的基础。

在这里,就是所使用的参考坐标系。

这个参数的值rame可能是摄像头传感器的坐标系,它定义了摄像头的位置和方向。

是一种用于3D环境建模的数据结构,是一种八叉树的应用。可以通过传感器数据(如深度相机、激光雷达等)来创建和更新3D环境的模型。

在中,环境被划分为立方体的单元格,每个单元格可以存储关于该空间的信息,如是否被占用(即有物体存在)。

是一种稀疏的数据结构,只有在有物体存在或者被传感器探测到的区域才会创建单元格,这意味着它只在有物体存在的地方存储数据,使得内存使用更加有效率、高效地处理大规模的环境。

八叉树常常与其他的空间划分结构如kd树、二叉空间划分树(BSP tree)、四叉树(,为二维的版本)等进行比较。下面是八叉树相比于其他空间数据结构的一些优缺点:

优点:

空间效率:八叉树有助于减少内存的使用。它通过在需要详细描述的空间区域(例如,物体所在的地方)创建更细的划分,并在空旷或均匀的区域使用较粗的划分,从而实现了空间效率。

查询效率:在处理空间查询时(如范围搜索、最近邻搜索等),八叉树可以提供较高的效率。这是因为它能快速地排除掉不可能包含查询结果的大块区域。

分层和多分辨率表示:八叉树的层次化特性使得它能够支持分层和多分辨率的空间表示,这在许多应用中是非常有用的,例如LOD(Level of )渲染、碰撞检测、路径规划等。

缺点:

构建和更新开销:构建和更新八叉树可能会花费一定的计算开销,尤其是在动态环境中。因为每当物体移动或场景发生变化时,八叉树可能需要进行重建或更新。

不适合处理特定模式的数据:对于某些特定模式的数据,例如高度平面化的数据或线性分布的数据,八叉树可能不如其他结构如kd树或BSP树那么高效。

不均衡的分区:由于八叉树的划分方式是均匀的,因此在处理一些空间分布极不均匀的数据时,可能会导致树的结构非常不平衡,这可能影响查询效率。

    <param name="octomap_resolution" type="double" value="0.025" />
# 设定了Octomap的分辨率,值为0.025,一般单位是米。
# 这个值决定了Octomap中每个voxel体素的大小

Voxel( Pixel)体素是一种在三维空间中表示数据的单位,类似于二维图像中的像素(Pixel)。一个Voxel代表了三维空间中的一个小立方体区域。在中,每个Voxel就是一个单元格,可以存储关于这个小区域的信息,例如这个区域是否被占用。Voxel的大小(也就是立方体的边长)决定了3D模型的分辨率:Voxel越小,能够表示的细节就越丰富,但同时也需要更多的计算资源和存储空间。

<param name="max_range" type="double" value="5.0" />
# 设定了传感器的最大探测距离,值为5.0,单位也通常是米
# 超过这个距离的物体将被屏蔽

启动..xml

特定机器人的传感器相关启动文件将被调用,这个特定机器人由参数来确定。

    <!-- Load the robot specific sensor manager; this sets the moveit_sensor_manager ROS parameter --><arg name="moveit_sensor_manager" default="panda" /><include file="$(dirname)/$(arg moveit_sensor_manager)_moveit_sensor_manager.launch.xml" />

..xml

并无内容,这是在..xml中被调用的特定机器人的..xml

<launch>
</launch>

切片解析10:.

该特定的文件是用于启动RViz。

<launch><arg name="debug" default="false" /><arg unless="$(arg debug)" name="launch_prefix" value="" /><arg     if="$(arg debug)" name="launch_prefix" value="gdb --ex run --args" /><!--Retrieve the right rviz config file--><arg name="rviz_tutorial" default="false" /><arg name="rviz_config" default="$(dirname)/moveit.rviz" /><arg if="$(eval rviz_config=='')" name="command_args" value="" /><arg if="$(eval rviz_config!='' and not rviz_tutorial)" name="command_args" value="-d $(arg rviz_config)" /><arg if="$(eval rviz_tutorial)" name="command_args" value="-d $(dirname)/moveit_empty.rviz" /><node name="$(anon rviz)" launch-prefix="$(arg launch_prefix)" pkg="rviz" type="rviz" respawn="false"args="$(arg command_args)" output="screen"></node></launch>

debug设置

  <arg name="debug" default="false" /><arg unless="$(arg debug)" name="launch_prefix" value="" /><arg     if="$(arg debug)" name="launch_prefix" value="gdb --ex run --args" />
# 定义了一个参数debug,默认值为false
# 该值从demo.launch中通过pass_all_args="true"继承给moveit_rviz.launch
# 如果不debug就正常启动,launch_prefix=""
# 如果要debug就将launch_prefix设置为gdb --ex run --args

如果debug为true,的值将为gdb --ex run --args,这会使得文件在GDB(GNU调试器)环境下运行,便于调试。否则,为空。

RViz配置

  <!--Retrieve the right rviz config file--><arg name="rviz_tutorial" default="false" /><arg name="rviz_config" default="$(dirname)/moveit.rviz" />

参数默认值为false,用于开启RViz示教模式(载入空的RViz配置文件)

该参数在demo.中通过="true"继承给.

默认值为当前目录下的.rviz文件,以.rviz结尾的文件为RViz的配置文件,被用于设定RViz的显示参数,也可以在。

Panels:- Class: rviz/DisplaysHelp Height: 84Name: DisplaysProperty Tree Widget:Expanded:- /MotionPlanning1Splitter Ratio: 0.5Tree Height: 226- Class: rviz/HelpName: Help- Class: rviz/ViewsExpanded:- /Current View1Name: ViewsSplitter Ratio: 0.5
Visualization Manager:Class: ""Displays:- Alpha: 0.5Cell Size: 1Class: rviz/GridColor: 160; 160; 164Enabled: trueLine Style:Line Width: 0.03Value: LinesName: GridNormal Cell Count: 0Offset:X: 0Y: 0Z: 0Plane: XYPlane Cell Count: 10Reference Frame: <Fixed Frame>Value: true- Class: moveit_rviz_plugin/MotionPlanningEnabled: trueName: MotionPlanningPlanned Path:Links: ~Loop Animation: trueRobot Alpha: 0.5Show Robot Collision: falseShow Robot Visual: trueShow Trail: falseState Display Time: 0.05 sTrajectory Topic: move_group/display_planned_pathPlanning Metrics:Payload: 1Show Joint Torques: falseShow Manipulability: falseShow Manipulability Index: falseShow Weight Limit: falsePlanning Request:Colliding Link Color: 255; 0; 0Goal State Alpha: 1Goal State Color: 250; 128; 0Interactive Marker Size: 0Joint Violation Color: 255; 0; 255Query Goal State: trueQuery Start State: falseShow Workspace: falseStart State Alpha: 1Start State Color: 0; 255; 0Planning Scene Topic: move_group/monitored_planning_sceneRobot Description: robot_descriptionScene Geometry:Scene Alpha: 1Show Scene Geometry: trueVoxel Coloring: Z-AxisVoxel Rendering: Occupied VoxelsScene Robot:Attached Body Color: 150; 50; 150Links: ~Robot Alpha: 0.5Show Scene Robot: trueValue: trueEnabled: trueGlobal Options:Background Color: 48; 48; 48Fixed Frame: panda_link0Name: rootTools:- Class: rviz/InteractHide Inactive Objects: true- Class: rviz/MoveCamera- Class: rviz/SelectValue: trueViews:Current:Class: rviz/OrbitDistance: 2.0Enable Stereo Rendering:Stereo Eye Separation: 0.06Stereo Focal Distance: 1Swap Stereo Eyes: falseValue: falseField of View: 0.75Focal Point:X: -0.1Y: 0.25Z: 0.30Focal Shape Fixed Size: trueFocal Shape Size: 0.05Invert Z Axis: falseName: Current ViewNear Clip Distance: 0.01Pitch: 0.5Target Frame: panda_link0Yaw: -0.6232355833053589Saved: ~
Window Geometry:Displays:collapsed: falseHeight: 848Help:collapsed: falseHide Left Dock: falseHide Right Dock: falseMotionPlanning:collapsed: falseMotionPlanning - Trajectory Slider:collapsed: falseQMainWindow State: 000000ff00000000fd0000000100000000000001f0000002f6fc0200000007fb000000100044006900730070006c006100790073010000003d00000173000000c900fffffffb0000000800480065006c00700000000342000000bb0000006e00fffffffb0000000a00560069006500770073000000010c000000a4000000a400fffffffb0000000c00430061006d00650072006100000002ff000001610000000000000000fb0000001e004d006f00740069006f006e00200050006c0061006e006e0069006e00670100000374000001890000000000000000fb00000044004d006f00740069006f006e0050006c0061006e006e0069006e00670020002d0020005400720061006a006500630074006f0072007900200053006c00690064006500720000000000ffffffff0000001600000016fb0000001c004d006f00740069006f006e0050006c0061006e006e0069006e006701000001b60000017d0000017d00ffffff00000315000002f600000001000000020000000100000002fc0000000100000002000000010000000a0054006f006f006c00730100000000ffffffff0000000000000000Views:collapsed: falseWidth: 1291X: 454Y: 25

.rviz文件中包含了一系列的面板(),显示器()和视图(views)。面板是RViz的界面元素,显示器则是用于在3D环境中展示数据的元素,视图则是控制3D环境的观察点的参数。

RViz配置文件的选择

 <arg if="$(eval rviz_config=='')" name="command_args" value="" /><arg if="$(eval rviz_config!='' and not rviz_tutorial)" name="command_args" value="-d $(arg rviz_config)" /><arg if="$(eval rviz_tutorial)" name="command_args" value="-d $(dirname)/moveit_empty.rviz" />

参数。它的值取决于的值以及参数的值。如果为空,即配置文件不存在,则为空。

如果不为空且为false,即配置文件存在,但并不开启示教模式,则的值为-d $(arg ),这会让rviz加载指定的rviz配置文件。

如果为true,则的值为-d $()/.rviz,加载一个空的rviz配置文件。

启动RViz

  <node name="$(anon rviz)" launch-prefix="$(arg launch_prefix)" pkg="rviz" type="rviz" respawn="false"args="$(arg command_args)" output="screen">

节点名称由$(anon rviz)生成,它会生成一个唯一的、匿名的节点名。-就是之前定义的参数,决定了是否已GDB调试来启动这个节点。

anon是ROS的特殊命令,用于确保每次启动的节点有一个独一无二的名字,这样就可以在同一ROS系统中同时启动多个这样的节点,而不会因为节点名字的冲突导致错误。

关于$(anon rviz)中的rviz,这个部分只是一个前缀,ROS会在字符rviz后面附加一个独一无二的字符串来生成节点名。选择rviz作为前缀是为了使生成的名字有更好的可读性,能清楚地知道这个节点与rviz有关。

比如,使用$(anon rviz)可能会生成如下的节点名:。在这个名字中,rviz是指定的前缀,后面的数字是ROS自动生成的,用来确保名字的唯一性。

pkg和type分别表示ROS包名和类型名,这里都是rviz。

参数设为false,意味着如果rviz节点停止,它不会自动重启。

args是之前定义的参数,它指定了rviz启动时的命令行参数为空或者.rviz或.rviz。

参数设为,表示rviz的输出将被发送到控制台。

切片解析11:.

文件名为//.,是的经典demo,在RViz中显示机器人模型并通过RViz的插件来控制完成运动规划和轨迹控制,同时在中进行联合仿真,模仿真实机械臂的控制。

以下为官方案例的//.完整代码:

<launch><!-- specify the planning pipeline --><arg name="pipeline" default="ompl" /><!-- Panda specific options --><arg name="load_gripper" default="true" /><arg name="transmission" default="effort" /><!-- Gazebo specific options --><arg name="gazebo_gui" default="true" /><arg name="paused" default="false" /><!-- Launch the gazebo simulator and spawn the robot --><include file="$(find franka_gazebo)/launch/panda.launch" pass_all_args="true"><arg name="headless" value="$(eval not arg('gazebo_gui'))" /><arg name="use_gripper" default="$(arg load_gripper)" /><arg name="controller" default="$(arg transmission)_joint_trajectory_controller" /></include><include file="$(dirname)/demo.launch" pass_all_args="true"><!-- robot description is loaded by gazebo.launch, to enable Gazebo features --><arg name="load_robot_description" value="false" /><!-- MoveItSimpleControllerManager provides ros_control's JointTrajectory controllersas well as GripperCommand actions --><arg name="moveit_controller_manager" value="simple" /></include>
</launch>

切片分析如下:

运动规划流水线

  <!-- specify the planning pipeline --><arg name="pipeline" default="ompl" />
# 设定运动规划流水线为ompl运动规划库

机械臂相关基本参数设置

  <!-- Panda specific options --><arg name="load_gripper" default="true" />
# 加载夹爪,该参数被传递给franka_gazebo/launch/panda.launch

  <arg name="transmission" default="effort" />
# 将传动方式设置为effort力控

设置

  <!-- Gazebo specific options --><arg name="gazebo_gui" default="true" />
# 设置gazebo_gui参数为true
# gazebo默认将显示图形化界面

  <arg name="paused" default="false" />
# 在启动时,默认不暂停仿真模拟器的时间在0s
# 这个参数其实可能在后续会被覆盖掉
# 不确定在传入文件时是否只给第一次赋值还是会将传入文件的所有该参数均赋值
# 如果只给第一次赋值,那么这个参数是无效的
# 如果给所有都赋值,那么这个参数是有效的

启动

  <!-- Launch the gazebo simulator and spawn the robot --><include file="$(find franka_gazebo)/launch/panda.launch" pass_all_args="true"><arg name="headless" value="$(eval not arg('gazebo_gui'))" /><arg name="use_gripper" default="$(arg load_gripper)" /><arg name="controller" default="$(arg transmission)_joint_trajectory_controller" /></include>

导入了//panda.文件,该文件用于在 模拟器中加载 Panda 机器人,并为其配置一系列参数和控制器。

向//panda.文件传递以上已经设置的所有参数。

根据的值设置参数

根据的值设置参数

根据传动方式设置参数,以为例,这里的被设定为

//panda.

该文件是包里的内容,要成功运行.需要先下载安装这个包

sudo apt install ros-noetic-franka-gazebo

该文件安装后的路径为:/opt/ros//share///panda.

这个文件的主要作用是在 模拟器中加载和配置 Panda 机器人,启动控制器,以及在需要时启动 RViz 和交互标记,顺便展示这个文件的详细内容,其中已经有官方详尽的注释了,写得很漂亮,建议参考:

<?xml version="1.0"?>
<launch><!-- Gazebo & GUI Configuration --><arg name="gazebo"      default="true"  doc="Should the gazebo simulation be launched? Use false in case if you want to include this file and launch gazebo yourself" /><arg name="headless"    default="false" doc="Should the gazebo GUI be launched?" /><arg name="paused"      default="false" doc="Should the simulation directly be stopped at 0s?" /><arg name="world"       default="worlds/empty.world" doc="Filename to a SDF World for gazebo to use" /><arg name="rviz"        default="false" doc="Should RVIz be launched?" /><!-- Robot Customization --><arg name="arm_id"      default="panda" doc="Name of the panda robot to spawn" /><arg name="use_gripper" default="true"  doc="Should a franka hand be mounted on the flange?" /><arg name="controller"  default=" "     doc="Which example controller should be started? (One of {cartesian_impedance,model,force,joint_position,joint_velocity}_example_controller)" /><arg name="x"           default="0"     doc="How far forward to place the base of the robot in [m]?" /><arg name="y"           default="0"     doc="How far leftwards to place the base of the robot in [m]?" /><arg name="z"           default="0"     doc="How far upwards to place the base of the robot in [m]?" /><arg name="roll"        default="0"     doc="How much to rotate the base of the robot around its X-axis in [rad]?" /><arg name="pitch"       default="0"     doc="How much to rotate the base of the robot around its Y-axis in [rad]?" /><arg name="yaw"         default="0"     doc="How much to rotate the base of the robot around its Z-axis in [rad]?" /><arg name="xacro_args"  default=""      doc="Additional arguments to pass to panda.urdf.xacro" /><arg name="initial_joint_positions"doc="Initial joint configuration of the panda. Specify as a list of name/value pairs in form of '-J [name-of-joint] [value-in-rad]'. Default is a 90 degree bend in the elbow"default="-J $(arg arm_id)_joint1 0-J $(arg arm_id)_joint2 -0.785398163-J $(arg arm_id)_joint3 0-J $(arg arm_id)_joint4 -2.35619449-J $(arg arm_id)_joint5 0-J $(arg arm_id)_joint6 1.57079632679-J $(arg arm_id)_joint7 0.785398163397-J $(arg arm_id)_finger_joint1 0.001-J $(arg arm_id)_finger_joint2 0.001"/><arg name="interactive_marker" default="$(eval arg('controller') == 'cartesian_impedance_example_controller')" doc="Should the interactive marker node be started?" /><include file="$(find gazebo_ros)/launch/empty_world.launch" if="$(arg gazebo)"><arg name="world_name" value="$(arg world)"/><!-- Always start in paused mode, and only unpause when spawning the model --><arg name="paused" value="true"/><arg name="gui" value="$(eval not arg('headless'))"/><arg name="use_sim_time" value="true"/></include><param name="robot_description"command="xacro $(find franka_description)/robots/panda/panda.urdf.xacrogazebo:=truehand:=$(arg use_gripper)arm_id:=$(arg arm_id)xyz:='$(arg x) $(arg y) $(arg z)'rpy:='$(arg roll) $(arg pitch) $(arg yaw)'$(arg xacro_args)"></param><rosparam file="$(find franka_gazebo)/config/franka_hw_sim.yaml" subst_value="true" /><rosparam file="$(find franka_gazebo)/config/sim_controllers.yaml" subst_value="true" /><param name="m_ee" value="0.76" if="$(arg use_gripper)" /><arg name="unpause" value="$(eval '' if arg('paused') else '-unpause')" /><node name="$(arg arm_id)_model_spawner"pkg="gazebo_ros"type="spawn_model"args="-param robot_description -urdf -model $(arg arm_id) $(arg unpause)$(arg initial_joint_positions)"/><!-- Spawn required ROS controllers --><node pkg="controller_manager"type="spawner"name="$(arg arm_id)_gripper_spawner"if="$(arg use_gripper)"args="franka_gripper"respawn="false"/><!-- spawns the controller after the robot was put into its initial joint pose --><node pkg="controller_manager"type="spawner"name="$(arg arm_id)_controller_spawner"respawn="false" output="screen"args="--wait-for initialized franka_state_controller $(arg controller)"/><node name="robot_state_publisher" pkg="robot_state_publisher" type="robot_state_publisher" /><node name="joint_state_publisher" type="joint_state_publisher" pkg="joint_state_publisher"><rosparam param="source_list">[franka_state_controller/joint_states, franka_gripper/joint_states] </rosparam><param name="rate" value="30"/></node><!-- Start only if cartesian_impedance_example_controller --><node name="interactive_marker"pkg="franka_example_controllers"type="interactive_marker.py"if="$(arg interactive_marker)"><param name="link_name" value="$(arg arm_id)_link0" /><remap to="cartesian_impedance_example_controller/equilibrium_pose" from="equilibrium_pose" /></node><node  pkg="rviz" type="rviz" output="screen" name="rviz" args="-d $(find franka_example_controllers)/launch/rviz/franka_description_with_marker.rviz" if="$(arg rviz)"/></launch>

  <include file="$(dirname)/demo.launch" pass_all_args="true"><!-- robot description is loaded by gazebo.launch, to enable Gazebo features --><arg name="load_robot_description" value="false" /><!-- MoveItSimpleControllerManager provides ros_control's JointTrajectory controllersas well as GripperCommand actions --><arg name="moveit_controller_manager" value="simple" /></include>
# 启动moveit_config/launch/demo.launch
# 在demo.launch中不加载robot_description因为在之前的 panda.launch 文件中已经加载过了
# 设置moveit_controller_manager为simple因为仿真可以视作简单的现实,因此不使用fake
# 使用simple类型的控制器管理器来管理和交互机器人的各个关节控制器

切片解析12:.

在.文件中启动的是/opt/ros//share///panda.,因为相关的启动文件通常放在机器人的文件夹下,同时官方也删除了/文件夹下的.文件。

其实在/下也存在一个相关的启动文件: .,它会在阶段被创建。

重新建立一个简单的机器人,生成的.代码如下:

<?xml version="1.0"?>
<launch><!-- Gazebo options --><arg name="gazebo_gui" default="true" doc="Start Gazebo GUI"/><arg name="paused" default="false" doc="Start Gazebo paused"/><arg name="world_name" default="worlds/empty.world" doc="Gazebo world file"/><arg name="world_pose" default="-x 0 -y 0 -z 0 -R 0 -P 0 -Y 0" doc="Pose to spawn the robot at"/><arg name="initial_joint_positions" default=" -J panda_joint1 0 -J panda_joint2 0 -J panda_joint3 0 -J panda_joint4 -1.5708 -J panda_joint5 0 -J panda_joint6 0 -J panda_joint7 0" doc="Initial joint configuration of the robot"/><!-- Start Gazebo paused to allow the controllers to pickup the initial pose --><include file="$(find gazebo_ros)/launch/empty_world.launch" pass_all_args="true"><arg name="paused" value="true"/></include><!-- Set the robot urdf on the parameter server --><param name="robot_description" textfile="$(find test_arm_moveit_config)/config/gazebo_panda.urdf" /><!-- Unpause the simulation after loading the robot model --><arg name="unpause" value="$(eval '' if arg('paused') else '-unpause')" /><!-- Spawn the robot in Gazebo --><node name="spawn_gazebo_model" pkg="gazebo_ros" type="spawn_model" args="-urdf -param robot_description -model robot $(arg unpause) $(arg world_pose) $(arg initial_joint_positions)"respawn="false" output="screen" /><!-- Load the controller parameters onto the parameter server --><rosparam file="$(find test_arm_moveit_config)/config/gazebo_controllers.yaml" /><include file="$(dirname)/ros_controllers.launch"/><!-- Spawn the Gazebo ROS controllers --><node name="gazebo_controller_spawner" pkg="controller_manager" type="spawner" respawn="false" output="screen" args="joint_state_controller" /><!-- Given the published joint states, publish tf for the robot links --><node name="robot_state_publisher" pkg="robot_state_publisher" type="robot_state_publisher" respawn="true" output="screen" />
</launch>

的启动参数

  <!-- Gazebo options --><arg name="gazebo_gui" default="true" doc="Start Gazebo GUI"/><arg name="paused" default="false" doc="Start Gazebo paused"/><arg name="world_name" default="worlds/empty.world" doc="Gazebo world file"/><arg name="world_pose" default="-x 0 -y 0 -z 0 -R 0 -P 0 -Y 0" doc="Pose to spawn the robot at"/><arg name="initial_joint_positions" default=" -J panda_joint1 0 -J panda_joint2 0 -J panda_joint3 0 -J panda_joint4 -1.5708 -J panda_joint5 0 -J panda_joint6 0 -J panda_joint7 0" doc="Initial joint configuration of the robot"/>
# 设置一些Gazebo需要的参数
# 设置初始的Gazebo中机械臂各关节的姿态

以暂停模式启动

  <!-- Start Gazebo paused to allow the controllers to pickup the initial pose --><include file="$(find gazebo_ros)/launch/empty_world.launch" pass_all_args="true"><arg name="paused" value="true"/></include>
# 加载gazebo的空世界,同时暂停在0s来方便控制器获取到初始位的姿态值

模拟器在初始加载后是暂停的。

这是为了让控制器有足够的时间获取机器人的初始姿态。

如果不先暂停模拟器,开始运行的模拟器中的机器人模型可能会在控制器有机会接收到初始姿态前就已经开始移动了,这可能会导致不正确的行为或是模拟器错误。

加载机器人描述文件到参数服务器

 <!-- Set the robot urdf on the parameter server --><param name="robot_description" textfile="$(find test_arm_moveit_config)/config/gazebo_panda.urdf" />
# 加载机器人描述文件到参数服务器

这个文件描述了机器人的模型,包括链接(links)、关节()和其他特性。是许多ROS节点(包括r和)需要的参数。

参数的设置

  <!-- Unpause the simulation after loading the robot model --><arg name="unpause" value="$(eval '' if arg('paused') else '-unpause')" />

设置一个参数,如果为真(也就是在启动后是暂停的),那么就是空字符串,否则是-。

这是因为在加载机器人模型后,如果模拟器最初没有被暂停,那么需要取消暂停以开始模拟。这行设置用于在适当的时候执行这个操作。

这意味着只有在模拟器被暂停时,参数 才会包含 - 字符串,这样在 节点中就会将模拟器从暂停状态恢复过来。反之,如果模拟器一开始就没有被暂停,那么 参数将为空字符串,即不会对模拟器的状态产生影响。

诞生机器人模型

  <!-- Spawn the robot in Gazebo --><node name="spawn_gazebo_model" pkg="gazebo_ros" type="spawn_model" args="-urdf -param robot_description -model robot $(arg unpause) $(arg world_pose) $(arg initial_joint_positions)"respawn="false" output="screen" />

="false": 这个选项表示,如果该节点因任何原因停止运行,ROS不应尝试重新启动它。

="": 这表示节点的输出应该被打印到屏幕。这对于调试和监控节点的运行情况很有用。

这个代码片段将URDF格式的机器人模型加载到模拟器中,模型的初始位置和关节状态由相应的参数定义。并且,根据参数的值,会在模型加载后解除模拟器的0s暂停状态。

加载控制器参数到参数服务器

 <!-- Load the controller parameters onto the parameter server --><rosparam file="$(find test_arm_moveit_config)/config/gazebo_controllers.yaml" />
# 将config/gazebo_controllers.yaml文件加载到参数服务器

.yaml

# Publish joint_states
joint_state_controller:type: joint_state_controller/JointStateControllerpublish_rate: 50

.yaml配置文为ROS中的控制器管理器()定义了将要管理的控制器及其相关参数。

此处定义了一个名为er的控制器。

启动.

<include file="$(dirname)/ros_controllers.launch"/>
# 引用了ros_controllers.launch在此处启动

这个没啥用,因为传入的控制器内容为空,所以也没有启动对应的控制器,可能是的作者想区分ros下的普通控制器和的控制器,也有可能是真实机械臂和的仿真需要做数字孪生同步进行,才有了这样的区别,仅作参考。

.

<?xml version="1.0"?>
<launch><!-- Load joint controller configurations from YAML file to parameter server --><rosparam file="$(find panda_moveit_config)/config/ros_controllers.yaml" command="load"  subst_value="true"/><!-- Load and start the controllers --><node name="controller_spawner" pkg="controller_manager" type="spawner" respawn="false" output="screen"args="$(arg transmission)_joint_trajectory_controller" />
</launch>

.将.yaml里的控制器的配置加载到参数服务器

随后启动包的来生成控制器。

这个节点的参数$(arg )指定了需要启动的控制器类型,假如此处为,则为类型的控制器。

在.文件中该值被传入,随后被传给.,随后再传给.并在此处被应用为,使得传动方式为力控

节点的参数是$(arg )。在这个案例中,这意味着它会试图启动名为的控制器。

.yaml

该文件为空,没有内容

启动.yaml中的控制器

  <!-- Spawn the Gazebo ROS controllers --><node name="gazebo_controller_spawner" pkg="controller_manager" type="spawner" respawn="false" output="screen" args="joint_state_controller" />

在此前.yaml中的控制器已经被加载到参数服务器,随后在此处被启动。

控制器管理者包中的节点将名为er的控制器启动(er在.yaml中存在)

发布机器人状态

  <!-- Given the published joint states, publish tf for the robot links --><node name="robot_state_publisher" pkg="robot_state_publisher" type="robot_state_publisher" respawn="true" output="screen" />
</launch>

r节点会发布机器人的关节状态,并生成tf()消息,用于追踪机器人各link的位姿。

切片解析13:.

使用手柄来控制,整活可以参考的手柄教程,此处不作延申。

<launch><!-- See moveit_ros/visualization/doc/joystick.rst for documentation --><arg name="dev" default="/dev/input/js0" /><!-- Launch joy node --><node pkg="joy" type="joy_node" name="joy"><param name="dev" value="$(arg dev)" /> <!-- Customize this to match the location your joystick is plugged in on--><param name="deadzone" value="0.2" /><param name="autorepeat_rate" value="40" /><param name="coalesce_interval" value="0.025" /></node><!-- Launch python interface --><node pkg="moveit_ros_visualization" type="moveit_joy.py" output="screen" name="moveit_joy"/></launch>

这个文件用于在ROS系统中被用于设置使用游戏手柄()来控制移动的机器人。

启动节点来处理游戏手柄的输入

dev - 这是游戏手柄设备的路径,默认为/dev/input/js0。这个路径可能需要根据具体系统进行更改。

- 死区阈值,如果手柄的位移小于这个值,那么它将被忽略,以避免由于手柄的微小移动导致的误操作。这个值默认为0.2。

- 这是自动重复的频率,单位是Hz,默认为40。这表示如果手柄的某个按钮被按住不放,那么这个节点将每秒生成40个相同的消息。

- 这是合并时间间隔,单位是秒,默认为0.025。如果在这个时间间隔内,有多个输入事件到达,那么这个节点将把它们合并成一个事件。

然后,这个文件启动另一个节点.py,这是一个接口,用于将游戏手柄的输入转换为!可以理解的控制信号。

切片解析14:.

用于ompl库的性能评估任务

<launch><!-- This argument must specify the list of .cfg files to process for benchmarking --><arg name="cfg" /><!-- Load URDF --><include file="$(dirname)/planning_context.launch"><arg name="load_robot_description" value="true"/></include><!-- Start the database --><include file="$(dirname)/warehouse.launch"><arg name="moveit_warehouse_database_path" value="moveit_ompl_benchmark_warehouse"/></include><!-- Start Benchmark Executable --><node name="$(anon moveit_benchmark)" pkg="moveit_ros_benchmarks" type="moveit_run_benchmark" args="$(arg cfg) --benchmark-planners" respawn="false" output="screen"><rosparam command="load" file="$(find panda_moveit_config)/config/ompl_planning.yaml"/></node></launch>

cfg

  <!-- This argument must specify the list of .cfg files to process for benchmarking --><arg name="cfg" />

定义了一个命令行参数,此参数指定要进行基准测试的.cfg文件列表。

启动.

  <include file="$(dirname)/planning_context.launch"><arg name="load_robot_description" value="true"/>include>
# 加载机器人描述文件,启动启动planning_context.launch

启动数据库

  <include file="$(dirname)/warehouse.launch"><arg name="moveit_warehouse_database_path" value="moveit_ompl_benchmark_warehouse"/>include>

.文件用于启动!的数据库服务。这个服务主要用于存储和检索运动规划问题,解决方案,状态等。

为数据库的路径。

  <node name="$(anon moveit_benchmark)" pkg="moveit_ros_benchmarks" type="moveit_run_benchmark" args="$(arg cfg) --benchmark-planners" respawn="false" output="screen"><rosparam command="load" file="$(find panda_moveit_config)/config/ompl_planning.yaml"/>node>

anon 的anon会给定独特的后缀,方便多个任务不重名地进行,启动s包的节点,---标志,表示需要基准测试规划器。

cfg参数在此前被定义,但在文件中没有赋值,所以要从外部命令行中指定这个参数的值,例如:

roslaunch package_name run_benchmark_ompl.launch cfg:=/path/to/your/config/file.cfg

这样,cfg参数就被赋值为/path/to/your//file.cfg,这个路径将会作为参数传递给节点。

同时在启动这个节点时加载参数.yaml到ROS参数服务器,用于读取ompl的设置,方便任务评估。

切片解析15:.


<launch><arg name="robot_ip" /><arg name="load_gripper" /><include file="$(find franka_control)/launch/franka_control.launch" pass_all_args="true" /><arg name="transmission" default="position" /><include file="$(dirname)/ros_controllers.launch" pass_all_args="true" /><include file="$(dirname)/demo.launch" pass_all_args="true"><arg name="load_robot_description" value="false" /><arg name="moveit_controller_manager" value="simple" />include>
launch>

加载真实机械臂控制

  <include file="$(find franka_control)/launch/franka_control.launch" pass_all_args="true" />

Emika Panda 是一个常用于研究和教学的七自由度机器人臂,也就是本篇所使用的demo机械臂Panda。

启动包的.并传递所有参数(如机械臂的IP和是否加载夹爪),.文件用于启动控制 Emika Panda实体机器人。

真实机械臂.

如果已经用一键配置安装脚本配过了,那么可以在/opt/ros//share//路径下找到.,内容如下:


<launch><arg name="robot_ip" /><arg name="robot" default="panda" doc="choose your robot. Possible values: [panda, fr3]"/><arg name="arm_id" default="$(arg robot)" /><arg name="load_gripper" default="true" /><arg name="xacro_args" default="" /><param name="robot_description" command="$(find xacro)/xacro $(find franka_description)/robots/$(arg robot)/$(arg robot).urdf.xacro hand:=$(arg load_gripper) arm_id:=$(arg arm_id) $(arg xacro_args)"/><include file="$(find franka_gripper)/launch/franka_gripper.launch" if="$(arg load_gripper)"><arg name="robot_ip" value="$(arg robot_ip)" /><arg name="arm_id"   value="$(arg arm_id)" />include><node name="franka_control" pkg="franka_control" type="franka_control_node" output="screen" required="true"><rosparam command="load" file="$(find franka_control)/config/franka_control_node.yaml" subst_value="true" /><param name="robot_ip" value="$(arg robot_ip)" />node><rosparam command="load" file="$(find franka_control)/config/default_controllers.yaml" subst_value="true" /><node name="state_controller_spawner" pkg="controller_manager" type="spawner" respawn="false" output="screen" args="franka_state_controller"/><node name="robot_state_publisher" pkg="robot_state_publisher" type="robot_state_publisher" output="screen"/><node name="joint_state_publisher" type="joint_state_publisher" pkg="joint_state_publisher" output="screen"><rosparam if="$(arg load_gripper)" param="source_list">[franka_state_controller/joint_states, franka_gripper/joint_states] rosparam><rosparam unless="$(arg load_gripper)" param="source_list">[franka_state_controller/joint_states] rosparam><param name="rate" value="30"/>node>
launch>

简单地解释部分内容:

  <param name="robot_description" command="$(find xacro)/xacro $(find franka_description)/robots/$(arg robot)/$(arg robot).urdf.xacro hand:=$(arg load_gripper) arm_id:=$(arg arm_id) $(arg xacro_args)"/>
# 加载了robot_description到ROS参数服务器
# 具体的模型内容通过参数hand:=$(arg load_gripper) arm_id:=$(arg arm_id) $(arg xacro_args)在xacro宏里进行选择
# 比如是否加载夹爪和其他的xacro_args需求

  <include file="$(find franka_gripper)/launch/franka_gripper.launch" if="$(arg load_gripper)"><arg name="robot_ip" value="$(arg robot_ip)" /><arg name="arm_id"   value="$(arg arm_id)" />include>
# 加载夹爪节点
# 不再拓展讲,有兴趣的自己看

  <node name="franka_control" pkg="franka_control" type="franka_control_node" output="screen" required="true"><rosparam command="load" file="$(find franka_control)/config/franka_control_node.yaml" subst_value="true" /><param name="robot_ip" value="$(arg robot_ip)" />node>
# 启动franka_control_node控制节点
# 载入相关配置参数franka_control_node.yaml

 <rosparam command="load" file="$(find franka_control)/config/default_controllers.yaml" subst_value="true" /><node name="state_controller_spawner" pkg="controller_manager" type="spawner" respawn="false" output="screen" args="franka_state_controller"/>
# 载入控制器参数default_controllers.yaml到ROS参数服务器
# 使用控制器管理者的spawner来启动franka_state_controller

  <node name="robot_state_publisher" pkg="robot_state_publisher" type="robot_state_publisher" output="screen"/><node name="joint_state_publisher" type="joint_state_publisher" pkg="joint_state_publisher" output="screen"><rosparam if="$(arg load_gripper)" param="source_list">[franka_state_controller/joint_states, franka_gripper/joint_states] rosparam><rosparam unless="$(arg load_gripper)" param="source_list">[franka_state_controller/joint_states] rosparam><param name="rate" value="30"/>node>
# 加载机器人状态发布器robot_state_publisher节点
# 加载机器人关节状态发布器joint_state_publisher节点

启用位置控制类型的

 <arg name="transmission" default="position" /><include file="$(dirname)/ros_controllers.launch" pass_all_args="true" />

启用位置控制类型的,也就是名为:的控制器,目前不确定该控制器被加载到ROS参数服务器中,但是在llers.yaml中可以发现如果使用类型的控制器管理者,名为$(arg )的控制器参数将会被加载到ROS参数服务器,这意味着当时能使用时,这个控制器能被正确地加载。

llers.yaml

controller_list:- name: $(arg transmission)_joint_trajectory_controlleraction_ns: follow_joint_trajectorytype: FollowJointTrajectorydefault: Truejoints:- $(arg arm_id)_joint1- $(arg arm_id)_joint2- $(arg arm_id)_joint3- $(arg arm_id)_joint4- $(arg arm_id)_joint5- $(arg arm_id)_joint6- $(arg arm_id)_joint7- name: franka_gripperaction_ns: gripper_actiontype: GripperCommanddefault: Truejoints:- $(arg arm_id)_finger_joint1

启动RViz窗口

  <include file="$(dirname)/demo.launch" pass_all_args="true"><arg name="load_robot_description" value="false" /><arg name="moveit_controller_manager" value="simple" />include>

启动经典的demo.,猜测是用于RViz中插件拖拽控制实体机械臂。

切片解析16:.


<launch><arg name="debug" default="false" /><arg unless="$(arg debug)" name="launch_prefix" value="" /><arg     if="$(arg debug)" name="launch_prefix" value="gdb --ex run --args" /><node pkg="moveit_setup_assistant" type="moveit_setup_assistant" name="moveit_setup_assistant"args="--config_pkg=panda_moveit_config"launch-prefix="$(arg launch_prefix)"required="true"output="screen" />launch>

传入--=参数,使得 能够直接加载这个包的内容,通常用于重配包。

当然,直接打开 手动载入也是一样的,怎么方便怎么来。

其他切片

包中还有其他的一些独有的文件,这在普通的包里没有,但是比较有用。

比如说CHOMP、LERP和STOMP是用于机器人路径规划的不同算法。在这个情况下,.、.和. 这些文件是用来启动和展示这些不同路径规划算法的。

.: CHOMP (- for ) 是一种机器人路径规划算法,它基于启发式优化来规划路径,避免与环境中的对象碰撞。这个 demo 文件会启动一个使用 CHOMP 算法进行路径规划的例子。

.: LERP ( ) 是最简单的路径规划算法之一,它只是简单地在机器人的当前位置和目标位置之间生成一条直线。但是,它没有考虑到环境中的障碍物,所以这个算法可能并不适合所有的情况。这个 demo 文件会启动一个使用 LERP 算法进行路径规划的例子。

.: STOMP ( for ) 是另一种机器人路径规划算法,它使用随机优化方法来规划路径。与 CHOMP 不同的是,STOMP 会考虑到机器人的动态性质,以及路径规划中的噪声和不确定性。这个 demo 文件会启动一个使用 STOMP 算法进行路径规划的例子。

这三个 . 文件是用来演示如何使用 和 ROS 来使用不同的路径规划算法的。选择哪种算法取决于你的特定需求和机器人的特性。

的源码解析

在配置包的文件解析中,有较多参数是导入到了ROS的参数服务器,但具体的实现和调用过程对用户是不透明的,如果需要弄懂就需要去深入的源代码,鉴于此篇文章长度太长,所以源码解析将放在另一篇文章,并在此处附上链接

TODO:源码解析的链接

关于我们

最火推荐

小编推荐

联系我们


版权声明:本站内容由互联网用户自发贡献,该文观点仅代表作者本人。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如发现本站有涉嫌抄袭侵权/违法违规的内容, 请发送邮件至 88@qq.com 举报,一经查实,本站将立刻删除。备案号:桂ICP备2021009421号
Powered By Z-BlogPHP.
复制成功
微信号:
我知道了