干扰环境下的机械臂全身动态避障与安全柔顺控制方法
CSTR:
作者:
作者单位:

作者简介:

通讯作者:

中图分类号:

TP273

基金项目:

浙江省自然科学基金项目(LY23F030009);国家自然科学基金项目(62203392, 62373329);浙江省自然科学基金白马湖实验室联合基金项目(LBMHD24F030002).


Whole-body dynamic collision avoidance and safety compliance control method of manipulator in interference environment
Author:
Affiliation:

Fund Project:

  • 摘要
  • |
  • 图/表
  • |
  • 访问统计
  • |
  • 参考文献
  • |
  • 相似文献
  • |
  • 引证文献
  • |
  • 资源附件
  • |
  • 文章评论
    摘要:

    针对干扰环境下机械臂的安全交互控制问题, 提出一种基于控制障碍函数的机械臂全身动态避障与安全柔顺控制方法. 为保证系统鲁棒安全的同时降低保守性以提高跟踪性能, 提出基于非线性干扰观测器的可调输入至状态安全高阶控制障碍函数, 其能够处理高相对度约束, 进而拓宽输入至状态安全控制障碍函数的适用范围. 进一步, 利用所提出的控制障碍函数建立不等式约束, 并在二次规划框架下通过最小限度修改参考控制输入来形成鲁棒安全关键控制器. 该控制器在机械臂连杆的多个位置构建与障碍物之间的虚拟安全屏障, 以实现整个机械臂对静/动态障碍物的规避. 同时, 在机械臂末端建立多个动态空间约束, 以确保机械臂在预设的安全区域内执行交互任务. 此外, 基于Nagumo定理证明安全集合的前向不变性, 并用仿真和实验验证所提出方法的有效性.

    Abstract:

    To address the safety interactive control problem for robotic manipulator in disturbed environments, a whole-body dynamic collision avoidance and safety compliance control method based on a control barrier function is proposed. To ensure the robust safety while reducing conservatism for improved tracking performance, a nonlinear disturbance observer-based tunable input-to-state safe high-order control barrier function (NDOB-TISSf-HoCBF) is proposed, which can handle high relative degree constraints, and it extends the applicability of the input-to-state safety control barrier function. Then, inequality constraints are established using the proposed control barrier function, and a robust safety critical controller based on the NDOB-TISSf-HoCBF is formulated by a quadratic program (QP) that modifies a nominal controller with minimal intervention. Virtual safety barriers are established between the obstacles and multiple positions of the links of the robotic manipulator, in order to achieve the avoidance of static/dynamic obstacles by the entire robot manipulator. At the same time, multiple dynamic spatial constraints are established at the end of the robotic manipulator to ensure that the manipulator performs interative tasks in the preset safety area. In addition, the forward invariance of the safe set is proven using the Nagumo's theorem, and the effectiveness of the proposed control method is validated through simulations and experiments.

    参考文献
    相似文献
    引证文献
引用本文

魏岩,俞佳琪,禹鑫燚,等.干扰环境下的机械臂全身动态避障与安全柔顺控制方法[J].控制与决策,2025,40(12):3528-3539

复制
相关视频

分享
文章指标
  • 点击次数:
  • 下载次数:
  • HTML阅读次数:
  • 引用次数:
历史
  • 收稿日期:2025-01-07
  • 最后修改日期:
  • 录用日期:
  • 在线发布日期: 2025-11-10
  • 出版日期: 2025-12-10
文章二维码