机器人ROS【免费下载链接】moveit2:robot: MoveIt for ROS 2项目地址https://gitcode.com/gh_mirrors/mo/moveit2点击查看免费下载导读混合规划Hybrid Planning是 MoveIt 2 在 ROS 2 平台上的核心架构探索它将全局规划 局部执行拆分为 Global Planner、Local Planner 与 Hybrid Planning Manager 三个可独立组合的 ROS 2 组件通过 action 与 topic 协作完成从运动请求到实时轨迹执行的全链路闭环。本文以moveit_hybrid_planning包CHANGELOG.rst为脉络结合 README.md、源码、配置文件与集成测试系统梳理该架构的组成、四类插件接口、参数配置与启动方式并沿版本时间线还原其从骨架搭建到成熟稳定的演进历程。读者读完后将掌握混合规划 demo 的启动与配置方法、每个插件在链路中的职责与源码实现以及该包近年来的关键技术决策。一、混合规划架构全景三大组件与四类插件从源码目录结构moveit_ros/hybrid_planning可以看出moveit_hybrid_planning包由三个 Component 节点与四类可插拔接口组成目录组件/插件职责hybrid_planning_manager/hybrid_planning_manager_componentHybridPlanningManager架构控制中枢接收用户的HybridPlanneraction 请求编排全局/局部规划器global_planner/global_planner_componentGlobalPlannerComponent提供全局规划 action 服务将MotionSequenceRequest交给插件求解local_planner/local_planner_componentLocalPlannerComponent周期迭代执行局部规划向控制器发布实时轨迹命令hybrid_planning_manager/planner_logic_pluginsplanner logic 插件定义反应式逻辑何时发送全局/局部规划请求、如何响应反馈事件global_planner/global_planner_pluginsglobal planner 插件实现具体的全局求解算法默认走 MoveIt 规划管线local_planner/trajectory_operator_pluginstrajectory operator 插件维护全局参考轨迹从当前状态提取下一个目标路点local_planner/local_constraint_solver_pluginslocal constraint solver 插件每个迭代周期计算局部解并输出控制器命令1.1 控制中枢HybridPlanningManager在 hybrid_planning_manager.hpp 中HybridPlanningManager通过pluginlib::ClassLoaderPlannerLogicInterface加载 planner logic 插件同时持有三个 action 接口rclcpp_action::Servermoveit_msgs::action::HybridPlanner对外暴露混合规划请求服务测试中以run_hybrid_planning为 action 名rclcpp_action::Clientmoveit_msgs::action::GlobalPlanner与rclcpp_action::Clientmoveit_msgs::action::LocalPlanner分别向全局、局部规划器发送请求。全局解MotionPlanResponse通过global_solution_sub_订阅获取executeHybridPlannerGoal()在独立线程中处理长耗时回调并用std::atomicbool stop_hybrid_planning_保证取消操作线程安全——这正是 CHANGELOG 中多次提到的action abortion与improve action cancellation演进所对应的实现。1.2 全局规划器GlobalPlannerComponentglobal_planner_component.hpp 中的GlobalPlannerComponent加载GlobalPlannerInterface插件提供GlobalPlanneraction 服务并在规划完成后将MotionPlanResponse发布到global_trajectory话题供 Local Planner 与 Manager 监听。1.3 局部规划器LocalPlannerComponentlocal_planner_component.hpp 定义了局部规划器的四个内部状态enum class LocalPlannerState : int8_t { ABORT -1, ERROR 0, UNCONFIGURED 1, AWAIT_GLOBAL_TRAJECTORY 2, LOCAL_PLANNING_ACTIVE 3 };LocalPlannerComponent 通过定时器按local_planning_frequency周期性调用executeIteration()内部同时加载 trajectory operator 与 local constraint solver 两个插件同时维护PlanningSceneMonitor监听/planning_scene、/collision_object、/joint_states话题以及 TF buffer用于碰撞检测与状态同步。局部解最终发布到local_solution_topic默认为控制器命令话题。二、四类插件逐一拆解接口职责与源码实现2.1 Planner Logic 插件决定何时做什么planner logic 插件实现了PlannerLogicInterface::react()将 Hybrid Planning 事件映射为具体的动作HybridPlanningAction如SEND_GLOBAL_SOLVER_REQUEST、SEND_LOCAL_SOLVER_REQUEST、RETURN_HP_SUCCESS。仓库自带两个 demo 插件SinglePlanExecutionsingle_plan_execution.cpp跑一次全局规划再用局部规划器执行全局解的最简逻辑。其状态机为收到请求 → 发送全局求解全局解可用时等待 action 完成全局 action 成功 → 启动局部规划器用local_planner_started_防止重复启动全局 action 中止 → 以PLANNING_FAILED终止局部规划成功 → 返回混合规划成功。ReplanInvalidatedTrajectoryreplan_invalidated_trajectory.cpp在 SinglePlanExecution 基础上增加反应式重规划——当局部规划器反馈COLLISION_AHEAD前方碰撞或LOCAL_PLANNER_STUCK局部规划卡住时重新发送全局求解请求以更新失效的全局轨迹。两个插件的 pluginlib 导出分别见 single_plan_execution_plugin.xml 与 replan_invalidated_trajectory_plugin.xml并通过package.xml的moveit_hybrid_planningexport 段对外声明。2.2 Global Planner 插件默认走 MoveIt 规划管线MoveItPlanningPipelinemoveit_planning_pipeline.cpp是唯一的全局规划插件它封装 MoveItCpp API初始化时声明planning_pipelines.pipeline_names、plan_request_params.*、planning_scene_monitor_options.*等参数plan()中把MotionSequenceRequest的第一个 item 转换为moveit_cpp::PlanningComponent的PlanRequestParameters调用plan()后把RobotTrajectory写入MotionPlanResponse返回。从源码可见该插件目前只接受单 item 的 motion sequence多 item 请求仅取第一个作为全局目标并给出警告。2.3 Trajectory Operator 插件路点采样与轨迹更新SimpleSamplersimple_sampler.cpp维护全局参考轨迹与路点索引next_waypoint_index_addTrajectorySegment()收到新的全局轨迹时直接替换参考轨迹global trajectory updates simply replace the reference trajectory并用computeTimeStamps()补全时间戳getLocalTrajectory()取出下一个目标路点作为局部轨迹当当前状态与目标路点的关节距离 ≤WAYPOINT_RADIAN_TOLERANCE0.2 radL1 范数时索引前进形成到达即推进的局部目标更新getTrajectoryProgress()以索引是否抵达末尾判断全局轨迹是否走完。2.4 Local Constraint Solver 插件碰撞检测与卡死检测ForwardTrajectoryforward_trajectory.cpp实现把下一个路点转发给控制器通过stop_before_collision参数默认false控制是否启用碰撞检查启用时用LockedPlanningSceneRO只读锁定规划场景调用isPathValid()校验局部轨迹无效则保持当前位置、清零速度/加速度并只发送一次COLLISION_AHEAD反馈内置卡死检测若连续STUCK_ITERATIONS_THRESHOLD5 次迭代中目标路点距离变化 ≤STUCK_THRESHOLD_RAD1e-4 rad则反馈LOCAL_PLANNER_STUCK并中止最终把RobotTrajectory转为JointTrajectory消息发布给控制器。该插件的卡死反馈正是 ReplanInvalidatedTrajectory 重规划逻辑的触发源两个插件通过LocalFeedbackEnumfeedback_types.hpp中的反馈字符串完成解耦。三、参数配置三个 YAML 与四张插件清单moveit_hybrid_planning的 demo 参数集中在 test/config 目录配合 hp_manager_parameters.yaml 与 local_planner_parameters.yaml 两个generate_parameter_library生成的参数定义使用。3.1 混合规划管理器参数hybrid_planning_manager.yaml 是架构中最小但最关键的一个文件——它决定整体行为逻辑planner_logic_plugin_name: moveit_hybrid_planning/ReplanInvalidatedTrajectory默认加载重规划插件如需一次规划、一次执行的简单行为可替换为moveit_hybrid_planning/SinglePlanExecution。该参数在hp_manager_parameters.yaml中声明类型为 string默认值即moveit::hybrid_planning/ReplanInvalidatedTrajectory。3.2 局部规划器参数local_planner.yaml 的完整参数如下对应local_planner_parameters.yaml中的声明与默认值参数类型demo 取值说明group_namestringpanda_arm使用的规划组trajectory_operator_plugin_namestringmoveit_hybrid_planning/SimpleSampler轨迹算子插件local_constraint_solver_plugin_namestringmoveit_hybrid_planning/ForwardTrajectory局部约束求解插件local_planning_frequencydouble100.0局部规划器迭代频率Hz默认 1.0global_solution_topicstringglobal_trajectory全局解订阅话题local_solution_topicstring/panda_joint_group_position_controller/commands局部解发布话题也可用panda_arm_controller/joint_trajectorylocal_solution_topic_typestringstd_msgs/Float64MultiArray局部解消息类型也可用trajectory_msgs/JointTrajectorypublish_joint_positionsbooltrue是否发布位置命令publish_joint_velocitiesboolfalse是否发布速度命令monitored_planning_scenestring/planning_scene参考规划场景话题默认/planning_scenecollision_object_topicstring/collision_object碰撞物体话题默认/collision_objectjoint_states_topicstring/joint_states关节状态话题默认/joint_statesstop_before_collisionbooltrueForwardTrajectory 专属碰撞前停车其中local_solution_topic_type支持两种控制器接口位置数组std_msgs/Float64MultiArray或关节轨迹trajectory_msgs/JointTrajectory配合publish_joint_positions/publish_joint_velocities可适配不同的控制器实现——这也是 CHANGELOG 中Enable different interfaces between local planner and controller#426与Add publish_joint_positions and publish_joint_velocities param两项演进留下的配置面。3.3 全局规划器参数global_planner.yaml 以global_planner_name指定插件moveit_hybrid_planning/MoveItPlanningPipeline其余参数沿袭 moveit_cpp 惯例分为三组命名空间planning_scene_monitor_options: name: planning_scene_monitor robot_description: robot_description joint_state_topic: /joint_states publish_planning_scene_topic: /planning_scene monitored_planning_scene_topic: /planning_scene wait_for_initial_state_timeout: 10.0 planning_pipelines: pipeline_names: [ompl] plan_request_params: planning_attempts: 1 planning_pipeline: ompl max_velocity_scaling_factor: 1.0 max_acceleration_scaling_factor: 1.0这些参数与MoveItPlanningPipeline::initialize()中的declare_parameter一一对应如plan_request_params.planning_attempts默认 5、planning_time默认 1.0、wait_for_initial_state_timeout默认 10.0 等可在运行时通过 action 请求中的MotionPlanRequest字段覆盖。3.4 控制器配置demo_controller.yaml 展示了 demo 的 ros2_control 硬件接口joint_trajectory_controller/JointTrajectoryControllerpanda_arm_controller、forward_command_controller/ForwardCommandControllerpanda_joint_group_position_controller与joint_state_broadcaster对应 Panda 的 7 个关节。注意 CHANGELOG 显示该配置经历了重要演进position_controllers在 2.5.1#1285被移除、2.15.0#3753彻底迁移出position_controllers改用 forward_command_controller2.15.2#3851又为 controller spawner 补充了参数文件。四、启动 Demo从 launch 到容器内组件编排README 给出的启动命令为ros2 launch moveit_hybrid_planning hybrid_planning_demo.launch.py该 demo 的实际编排逻辑集中在 hybrid_planning_common.py使用MoveItConfigsBuilder(moveit_resources_panda)加载 Panda 的 URDF/SRDF 与 OMPL 规划管线然后把三个组件放入同一个多线程 ComposableNodeContainerhybrid_planning_containermoveit::hybrid_planning::GlobalPlannerComponentglobal_plannermoveit::hybrid_planning::LocalPlannerComponentlocal_plannermoveit::hybrid_planning::HybridPlanningManagerhybrid_planning_manager三个节点分别接收各自的 YAML 参数global_planner.yaml、local_planner.yaml、hybrid_planning_manager.yaml全局与局部节点还叠加moveit_config.to_dict()提供机器人描述。这种进程内多组件 参数文件分离的组织方式对应 CHANGELOG 中Move common launch elements to a Python file, for easy re-use2.3.1与Launch file cleanup2.5.2的演进。五、集成测试验证 action 闭环与取消语义test_basic_integration.cpp 展示了混合规划 API 的标准用法可视为第三方集成的参考模板创建rclcpp_action::Clientmoveit_msgs::action::HybridPlanner连接run_hybrid_planningaction初始化PlanningSceneMonitor等待/joint_states与 action server 就绪构造MotionPlanRequest目标关节值、planner_idompl、allowed_planning_time2.0封装为MotionSequenceItemblend_radius0.0表示单目标并装入MotionSequenceRequest发送HybridPlanner::Goal含planning_group与motion_sequence通过 result/feedback 回调断言ActionCompletion成功。该测试与cancel_action.cpp、test_basic_integration.test.py共同构成集成测试面CHANGELOG 中关于测试的反复打磨#980 增加 action abortion 与测试、#1051 一度禁用测试、#3809 De-flake servo and hybrid_planning launch fixtures也印证了这类多进程集成测试的稳定性是持续维护重点。六、版本演进主线从架构骨架到工程化沉淀将 CHANGELOG.rst 与源码结构对照可以还原出moveit_hybrid_planning的清晰演进脉络6.1 架构奠基期2.3.x – 2.5.x2021–20222.3.0引入Hybrid planning architecture#311搭建 manager / global planner / local planner 骨架与简单状态机后续#426重构为 component plugin 结构新增forward_trajectory局部求解插件与next_waypoint_sampler后更名simple_sampler轨迹算子插件并用 ros2_control 仿真关节2.3.1–2.3.2Enable reaction to planner failure in the planner logic、Add generic global planner plugin, support MotionSequenceRequest#585——全局规划器抽象为插件接口支持运动序列请求2.4.0Put hybrid planning actions under a common namespace#932、修复全局规划 action 命名#9602.5.0[hybrid planning] configurable planning scene topics#1052、Use a map of expected feedback codes#1065、Adjust planning scene locking#1087改用LockedPlanningSceneRO并复制规划场景、使用 const 机器人状态、Add action abortion and test#980、Delete the pass-through option#986——这一系列提交把碰撞检查、规划场景访问与取消语义打磨成型。6.2 工程化与并行能力期2.6.x – 2.10.x2022–20242.6.0Parallel planning pipelines#1420在 MoveItCpp 层面引入MultiPipelinePlanRequestParameters支持多规划管线并行求解与solution_selection_callback选择机制为混合规划提供更丰富的全局求解能力2.7.2[hybrid planning] improve planning scene monitoring#1090——局部约束求解器内创建独立的 PlanningSceneMonitor、降低规划场景更新频率、改用updateSceneWithCurrentState()2.7.4以rclcpp版本判断替代ROS_DISTRO环境变量检查#21352.8.0Replaced numbers with SystemDefaultsQos()#2271以 QoS 枚举替代魔法数字2.9.0全面切换到节点化日志#2599/#2482、支持规划器链#2457、float→double 迁移#23432.10.0Remove HP error codes interface#2774、Unify log names#2720、Clean-up hybrid planning package#2603以及ros-planning组织整体迁移为moveit#2847。6.3 现代化与兼容期2.11.x – 2.15.x2024–20262.12.0.h→.hpp头文件统一#31132.13.0适配generate_parameter_library 0.4.0#32552.15.0Remove use of ament_target_dependencies#3726改用命名空间 CMake target如moveit_ros_planning::moveit_ros_planning、Replace rclcpp::Rate with rclcpp::WallRate#3558、迁移出已移除的position_controllers#3753、de-flake 测试夹具#3809、为 GCC 15 补cstdint/fstreaminclude#37542.15.1–2.15.2修复 Ubuntu 26.04 的 CI#3818、弃用 FindBoost.cmake以及为 controller spawner 提供参数文件#3851。从这一时间线可以看到混合规划包在保持三组件 四插件架构稳定的同时持续吸收 MoveIt 整体的工程化成果节点日志、QoS 规范、C 头文件规范、参数库化与 CMake 现代化。当前仓库中的插件清单forward_trajectory_plugin.xml、moveit_planning_pipeline_plugin.xml、simple_sampler_plugin.xml、single_plan_execution_plugin.xml、replan_invalidated_trajectory_plugin.xml与package.xml中的插件导出声明正是这套演进沉淀下来的最终形态。结语moveit_hybrid_planning的价值在于提供了一个清晰的全局求解 局部实时执行 反应式逻辑分层范式Manager 通过 planner logic 插件定义行为策略Global/Local Planner 各自通过插件接口隔离算法实现topic 与 action 的解耦则让碰撞检测、卡死恢复与重规划成为可插拔的能力。无论是直接运行 demo、按test_basic_integration.cpp的模式接入自己的机器人还是编写自定义插件替换四类接口中的任一环节本文所梳理的组件职责、参数语义与源码路径都足以作为切入的索引。赞分享机器人ROS【免费下载链接】moveit2:robot: MoveIt for ROS 2项目地址https://gitcode.com/gh_mirrors/mo/moveit2点击查看免费下载相关推荐MoveIt 2 Hybrid Planning 混合规划架构深度解析架构、插件体系与配置实战MoveIt 2 Hybrid Planning 混合规划架构深度解析架构、插件体系与配置实战 Hybrid Planning 是 MoveIt 2 中一种将机器人ROSMoveIt 2 CHOMP 规划器接口chomp_interface演进全解析插件架构、参数调优与 ROS 1→ROS 2 移植路线图MoveIt 2 CHOMP 规划器接口chomp_interface演进全解析插件架构、参数调优与 ROS 1→ROS 2 移植路线图 本文以 chom机器人ROSMoveIt 2 插件元包moveit_plugins演进全解析从控制器插件到 ROS 2 集成MoveIt 2 插件元包moveit_plugins演进全解析从控制器插件到 ROS 2 集成 导读 本文基于 moveit_plugins/movei机器人ROS上一篇在 Kubernetes 上部署有状态 H2O-3 集群StatefulSet、Headless Service 与 Helm 实践指南下一篇wasm-pack 命令体系全解new、build、pack、publish、test 与全局日志级别配置创作声明：本文部分内容由AI辅助生成（AIGC），仅供参考