• CN:11-2187/TH
  • ISSN:0577-6686

机械工程学报 ›› 2015, Vol. 51 ›› Issue (19): 21-27.doi: 10.3901/JME.2015.19.021

• 机构学及机器人 • 上一篇    下一篇

不确定环境球型腕自适应滑模扰动控制

张永顺, 郭建超, 王新, 满达   

  1. 大连理工大学精密与特种加工教育部重点实验室
  • 出版日期:2015-10-05 发布日期:2015-10-05
  • 基金资助:
    国家自然科学基金资助项目(61175102, 51277018)

Adaptive Sliding Mode Control of a Spherical Wrist for Restraining Disturbance in Uncertain Environment

ZHANG Yongshun, GUO Jianchao, WANG Xin, MAN Da   

  1. Key Laboratory for Precision & Non-traditional Machining of Ministry of Education, Dalian University of Technology
  • Online:2015-10-05 Published:2015-10-05

摘要: 针对目前机械手腕结构复杂、集成度低、运动耦合、抗不确定因素“干扰”能力差等问题,提出一种由相对独立运动链组成的三自由度高集成解耦球型腕机构及其自适应滑模控制方法。球型腕采用双半球和双万向节的解耦结构保证腕关节的紧凑性与灵活性。分析运动传递关系,推导正、逆运动学方程及动力学方程,建立作业空间与关节空间的运动传递关系和系统控制模型,构建三自由度解耦球型腕试验平台。主动控制系统采用非线性Terminal滑膜控制器结合RBF神经网络算法评估不确定性上界,保证系统控制误差快速收敛,利用Lyapunov稳定性理论证明控制系统的稳定性。仿真和试验结果表明该控制方法对不确定性扰动不敏感,削弱滑模控制的“抖振”,能够快速、准确地跟踪轨迹,实现精确的定位控制。

关键词: RBF神经网络, 轨迹跟踪, 滑模控制, 三自由度球型腕

Abstract: To overcome some shortcomings of existing wrists, such as complex structure, low integration, kinematic coupling and poor ability to resist uncertain disturbance, a 3-DOF decoupling spherical wrist with independent kinematic chain and adaptive sliding mode control is proposed. The decoupling structure of double hemispheres and double universal joints is employed to guarantee compactness and flexibility of the spherical wrist. To analyze the transitive relation of the wrist, the forward and inverse kinematics and dynamics are derived. The system control model and motion transitive relation between the working space and the joint space are established, the experimental platform of the 3-DOF decoupled spherical wrist is established. A nonlinear terminal sliding surface controller and RBF neural network are employed to increase convergent speed of the system. The Lyapunov function is used to prove the stability of the control system. Simulation and experiment demonstrate that the proposed control method is insensitive to uncertain disturbance, the chattering of sliding mode system is reduced, trajectory tracking control ability is good, and higher positional accuracy is realized.

Key words: 3-DOF spherical wrist, RBF neural network, sliding mode control, trajectory tracking

中图分类号: