现代制造工程 ›› 2026, Vol. 552 ›› Issue (9): 40-47.doi: 10.16731/j.cnki.1671-3133.2026.09.005

• 机器人技术 • 上一篇    下一篇

基于非线性模型预测控制的移动机械臂协调控制与避障方法研究

戴杰1, 焦嵩鸣1,2, 潘志毅1, 杨晨渤1   

  1. 1 华北电力大学控制与计算机工程学院,保定 071003;
    2 保定市电力系统智能机器人感知与控制重点实验室,保定 071003
  • 收稿日期:2025-07-14 出版日期:2026-09-18 发布日期:2026-10-22
  • 通讯作者: 焦嵩鸣,博士,副教授,主要研究方向为机器人智能感知及电力机器人自主巡检。E-mail:jiaosongming@ncepu.edu.cn
  • 作者简介:戴杰,硕士研究生,主要研究方向为移动机械臂协调控制。潘志毅,硕士研究生,主要研究方向为无人机风机巡检。杨晨渤,硕士研究生,主要研究方向为无人机输电线路巡检。E-mail:daijie0327@163.com

Research on coordination control and obstacle avoidance method for mobile manipulators based on nonlinear model predictive control

DAI Jie1, JIAO Songming1,2, PAN Zhiyi1, YANG Chenbo1   

  1. 1 School of Control and Computer Engineering,North China Electric Power University,Baoding 071003,China;
    2 Baoding Key Laboratory of Intelligent Robot Perception and Control in Electric Power System,Baoding 071003,China
  • Received:2025-07-14 Online:2026-09-18 Published:2026-10-22

摘要: 针对移动机械臂在动态环境中末端轨迹跟踪精度低及动态避障安全性不足的问题,提出了一种基于非线性模型预测控制(Nonlinear Model Predictive Control,NMPC)与动态安全裕度控制障碍函数(Dynamic Safety Margin Control Barrier Function,DSM-CBF)的移动机械臂协调控制与动态避障方法,使移动机械臂在运动过程中能实时感知周围环境与障碍物运动状态,动态调整避障安全裕度,以克服传统控制障碍函数(Control Barrier Function,CBF)在处理高速和不确定运动障碍物时的局限性。该方法采用NMPC进行系统优化控制,以实现移动机械臂末端轨迹跟踪,同时把DSM-CBF动态避障约束集成至NMPC框架中,以确保动态避障的安全性和有效性。仿真结果表明,相比基于距离约束的NMPC(NMPC with Distance Constraint,NMPC-DC)方法和标准控制障碍函数约束的NMPC(NMPC with Control Barrier Function,NMPC-CBF)方法,该方法显著提升了移动机械臂在复杂动态环境下的避障成功率,提高了移动机械臂的轨迹跟踪精度和系统协调性。

关键词: 非线性模型预测控制, 动态安全裕度控制障碍函数, 协调控制, 动态避障, 移动机械臂

Abstract: To address the issues of low end-effector trajectory tracking accuracy and insufficient safety in dynamic obstacle avoidance for mobile manipulators, a coordination control and dynamic obstacle avoidance method is proposed based on Nonlinear Model Predictive Control (NMPC) and Dynamic Safety Margin Control Barrier Function (DSM-CBF). During motion,the mobile manipulator can perceive the surrounding environment and the motion states of obstacles in real-time,dynamically adjusting the safety margin for obstacle avoidance. This approach overcomes the limitations of traditional Control Barrier Functions (CBF) in handling high-speed and uncertain moving obstacles. The proposed method employs NMPC for system optimization control,ensuring end-effector trajectory tracking of the mobile manipulator. Meanwhile,the DSM-CBF based dynamic obstacle avoidance constraints are integrated into the NMPC optimization process,guaranteeing both the safety and effectiveness of dynamic obstacle avoidance. Simulation results demonstrate that,compared to the NMPC with Distance Constraints (NMPC-DC) method and the standard NMPC with Control Barrier Function (NMPC-CBF) method,the method significantly improves the obstacle avoidance success rate of the mobile manipulator in complex dynamic environments,enhancing both the trajectory tracking accuracy and the overall system coordination.

Key words: Nonlinear Model Predictive Control (NMPC), Dynamic Safety Margin Control Barrier Function (DSM-CBF), coordination control, dynamic obstacle avoidance, mobile manipulator

中图分类号: 

版权所有 © 《现代制造工程》编辑部 
地址:北京市东城区东四块玉南街28号 邮编:100061 电话:010-67126028 电子信箱:2645173083@qq.com
本系统由北京玛格泰克科技发展有限公司设计开发 技术支持:support@magtech.com.cn