平面开链机械臂动力系统及其控制的向量键合图建模与分析

平面开链机械臂动力系统及其控制的向量键合图建模与分析易仲庆;谢进;张建奇

【摘要】平面开链机械臂是由一系列电机驱动单臂串联而成.利用这种串联式的结构特性,建立了电机驱动单臂的子系统机电耦合向量键合图模型以及等价动力学一阶微分方程,并利用模块化的方式建立出整个平面开链机械臂系统的键合图动力学模型.模型中通过考虑电机输出轴以及机械臂的挠性,实现微分因果关系的消除.以平面2R机械臂为例,通过对含有PD控制器的机电耦合系统动力学模型进行键合图仿真与Matlab仿真的结果对比,以及容性元件取值对系统动态响应影响的分析,验证了所提出方法的正确和有效性.%A planar open chain manipulator is composed of a series of single arm actuated by a motor.This serial chain nature make it possible to establish the vector bond graph model and equivalent dynamic first order differential equation of electromechanical coupling for the single arm actuated by a motor firstly,and then to establish the vector bond graph and dynamics modeling for the whole manipulator by the modular method.The differential causality is solved by considering the flexible of the motor output shaft and manipulator.A planar 2R manipulator is taken as an example to demonstrate the method proposed in it and its effectiveness and correctness as well,by comparing the simulation results from Bond Graph and Matlab simulation of the system with the PD controller and analysing the influence of the value of the capacitive element on dynamic response of the system.

【期刊名称】《机械设计与制造》

【年(卷),期】2017(000)003

【总页数】5页(P60-63,67)

【关键词】向量键合图;机电耦合;开链机械臂

【作者】易仲庆;谢进;张建奇

【作者单位】西南交通大学机械工程学院,四川成都610031;西南交通大学机械工程学院,四川成都610031;西南交通大学机械工程学院,四川成都610031

【正文语种】中文

【中图分类】TH16

机电一体化是机械工业的一个重要发展方向。在机电一体化中，机电之间的耦合关系是机械学科新的研究课题。建立机电系统耦合动力学模型、对机电系统的耦合效应进行定量分析是复杂机电系统动力学分析、动态特性分析、故障诊断等所必须解决的关键问题[1-2]。

键合图[3]理论以能量守恒原理为基础，将多种物理参量用统一的势、流、变位和动量4种状态变量表示，可以直观地描述系统内部状态的变化过程，是一种用统一的方式处理多种能量范畴的工程系统的动态分析方法[4]，与其他理论和方法结合在一起，可以成为机电系统分析及控制的有效工具[5-7]。

文献[8，9]研究了利用键合图的方法建立各种机电系统动力学分析模型的问题；文献[10]应用敏感性键合图对机电系统中的控制问题进行了分析；文献[11]在利用键合图建立了摄像机仰俯系统的动力学模型的基础上，对控制器的设计进行了深入的研究。然而，利用键合图对机电系统中的电机、机构以及控制器进行全面的分析和研究仍然需要探索出有效的方法[12]。

相比于传统标量键合图，向量键合图（Vector of Bond Graph）方法具有表达形式简明紧凑，包含信息量大的特点[13]，在多能域特别是复杂多体系统多能域分析时具有明显的优势。

平面开链机械臂是一种主要的工业机器人机构，其动力学性能直接影响到机器人的性能及其控制系统的设计。常用的工业机器人动力学建模理论和方法是Newton-Euler方法[14]和Lagrangian方法和基于文献[15]。这些方法重点研究的是机械臂本体的动力学问题，很少涉及到驱动电机的动力学问题。Lagrange-Maxwell 方法[16]综合考虑了电机和机械系统的动力分析问题，但是所建立的方程式还是二阶的微分方程，并且不能直观地描述机电系统的能量传递和变化等方面的信息。以永磁同步电机驱动的平面开链机械臂为研究对象，研究向量键合图方法在机械臂动力学方程的建立及控制系统中的应用，以探索出考虑驱动电机的机器人机构动力学和控制分析、设计的有效方法。

2.1 平面开链机械臂的结构

一个平面nR开链机械臂物理模型，如图1所示。

机械臂由n个活动构件和n个转动副组成。当机构为全驱动机构时，在每个转动副处应安装一个驱动器。

在研究中，驱动器为永磁同步电机（PMSM），则驱动器与其驱动杆件之间形成了一个机电耦合的子系统，其控制原理图，如图2所示。显然，图1所示的平面nR开链机械臂应包含有n个图2所示的子系统。

2.2 平面开链机械臂子系统的键合图及动力学模型

子系统中主要的物理部件包括驱动电动机及其直接驱动的机械臂。

2.2.1 驱动电动机的动力学建模

永磁同步电动机的工作原理图，如图3所示。根据电动机工作原理和功率流向，可以建立电机的键合图模型，如图4所示。