赵海滨;于清文;刘冲;陆志国;颜世玉
【摘 要】利用Matlab/Simulink软件设计机械臂控制系统仿真实验,包括机械臂模型、轨迹规划、逆动力学控制和运动学.以两自由度机械臂为研究对象,根据动力学方程建立机械臂模型.采用5阶多项式进行轨迹规划,并采用逆动力学进行机械臂的控制.通过运动学获取各个关节的位置坐标,动态的显示机械臂的运动过程.该仿真实验能够加深学生对机器人动力学、运动学和控制等理论的理解,有利于培养学生的实际编程能力,激发学生的学习热情. 【期刊名称】《实验室研究与探索》
【年(卷),期】2018(037)011
【总页数】5页(P100-104)
【关键词】机械臂;轨迹规划;逆动力学控制;运动学;Matlab仿真
【作 者】赵海滨;于清文;刘冲;陆志国;颜世玉
【作者单位】东北大学机械工程与自动化学院,沈阳110819;东北大学机械工程与自动化学院,沈阳110819;东北大学机械工程与自动化学院,沈阳110819;东北大学机械工程与自动化学院,沈阳110819;东北大学机械工程与自动化学院,沈阳110819
思情乐园
【正文语种】中 文
【中图分类】TP242
0 引 言
机器人是一门跨专业，高度综合的新兴学科[1]，无论在基础理论方面还是在实践应用方面发展速度都非常快。越来越多的高等学校面向高年级本科生和低年级研究生开设机器人学等机器人领域的相关课程，并对课程的改革进行了研究[2-4]。机器人课程的教学包括理论教学和实验教学[5-7]。由于资金和设备等原因，各个高校往往以理论教学为主，对实验教学不够重视。在机器人课程的理论教学中存在大量的公式推导和微分方程等，对于学生比较抽象、复杂和难以理解。因此，采用Matlab/Simulink软件进行机器人的仿真和控制实验非常必要。
在机器人的教材中，机器人动力学部分的公式推导均以两自由度机械臂为例，本文也以两自由度机械臂为研究对象。根据机械臂的动力学方程，采用Matlab/Simulink软件建立机械臂仿真模型，采用五阶多项式进行轨迹规划，并采用逆动力学进行机械臂的控制。通过机械臂的运动学方程获取关节的位置坐标，并动态的显示机械臂的运动过程。最后，对机械臂控制系统进行动态仿真，并对仿真结果进行了分析。学生可以修改参数，然后进行动态仿真。通过仿真实验，向学生完整的展示机械臂的控制过程，能够加深学生对机器人动力学、运动学和控制等理论的理解，增强学生的编程能力和学习兴趣，有助于机器人课程的理论和实验教学。
1 机械臂
本文以两自由度机械臂为研究对象，通过拉格朗日方程建立动力学方程[1]为
(1)
式中：q=[q1;q2]为角度向量；和分别为角速度和角加速度；τ=[τ1;τ2]为驱动力矩向量；为正定惯性矩阵；为科里奥利和离心力的结合矩阵；为重力势能矩阵；
游艇门根据式(1)，求解出为
(2)
在动力学方程中，机械臂的参数[8-9]如下：
d11=
c12=2c11
c21=0
g1=(m1+m2)gr1cos(q2)+m2gr2cos(q1+q2)
g2=m2gr2cos(q1+q2)
式中：m1和m2分别为两个连杆的质量；r1和r2分别为两个连杆的长度；J1和J2分别为两个连杆的转动惯量；g为重力加速度。
2 控制系统
本文以两自由度机械臂为研究对象，采用Matlab/Simulink软件建立综合性仿真实验平台。根据动力学方程建立机械臂的模型，然后采用轨迹规划和逆动力学控制进行机械臂的控制，最后通过运动学方程将机械臂在关节空间的坐标转换为工作空间下的位置坐标，并将机械臂的运动通过动画的形式进行显示。机械臂控制仿真系统如图1所示。
机械臂的控制方法有PD控制、带重力补偿的PD控制、逆动力学控制、鲁棒控制和自适应控制等。本文采用常用的逆动力学控制方法。机械臂的轨迹规划采用点到点运动方法，常用的有3阶多项式轨迹规划、5阶多项式轨迹规划、带有抛物线的直线段方法和开关(bang-bang)方法等。本文采用5阶多项式轨迹规划方法。
图1 机械臂控制系统原理图
2.1 轨迹规划
轨迹规划采用点到点运动， 即规划一条从初始位置q(t0)到最终位置q(tf)的轨迹。本文采用5阶多项式轨迹规划方法[10]。在t0时刻的角度、角速度和角加速度分别满足：
(3)
在tf时刻的角度、角速度和角加速度分别满足：
(4)
采用如下的5阶多项式轨迹，
q(t)=a0+a1t+a2t2+a3t3+a4t4+a5t5
验证码自动输入
(5)
根据起始位置和终点位置的角度、角速度和角加速度，可以得到下面的方程组：
(6)
通过求解该方程组可以得到参数ai(i=0,1,…,5)。然后，可以得到期望角度、角速度和角加速度分别为：
(7)
2.2 逆动力学控制
根据机械臂的动力学方程(1)，选择控制输入为
(8)
通过比较式(1)和式(8)可以得到
(9)
稳定的控制律y可以选择为
(10)
式中，参数Kp和Kd为对角阵，可以选择为Kp=Kd=diag(2ω1,2ω2)，固有频率为ωi，i=1,2。
期望轨迹为qd(t)，为了跟踪该轨迹，选择r为
(11)
将式(11)代入到式(10)，然后再代入到式(9)，可以得到二阶微分方程
(12)扫读笔
式中，
2.3 运动学方程
正运动学是根据机械臂各个关节的角度值，来确定工作空间下的位置坐标。对于具有两个自由度的机械臂，q1和q2分别为两个关节的角度，r1和r2分别为两个关节的长度，则第1个关节末端的位置坐标x1,y1为
(13)
第2个关节末端的位置坐标x2,y2为
(14)
3 仿真实验
Matlab功能强大、使用简单方便，并且对问题的描述和求解符合人们的思维习惯和数学表
达习惯，已经广泛应用于动态系统仿真[11]。Simulink是Matlab软件最重要的组件之一，能够进行系统建模、仿真和综合分析等[12]。Simulink和外界硬件的接口还可以建立半实物仿真和实时控制实验[13]。在Simulink系统中用户自定义函数库中的Matlab Function模块，可以采用Matlab语言非常方便灵活的建立复杂系统[14]。Matlab/Simulink软件非常适合进行机器人的控制和仿真实验[15-16]，因此本文采用Matlab/Simulink软件建立仿真实验系统。
苜蓿根两自由度机械臂的参数选择为：m1=0.5 kg，m2=1.5 kg，r1=1 m，r2=0.8 m，J1=5 kg·m，J2=5 kg·m，g=9.81 m/s2。在逆动力学控制中参数Kp=diag(9,9)，Kd=diag(6,6)。
>卡门涡街效应
豫公网安备41160202000603
站长QQ:729038198
关于我们
投诉建议