第5章-机器人的控制基础

控制器编成器安川六自由度工业机器人机器人控制的功能、组成和分类•机器人控制系统的组成•控制计算机控制系统的调度指挥机构。一般为微型机、微处理器有32位、64位等，如奔腾系列CPU.•示教盒示教机器人的工作轨迹和参数设定，以及所有人机交互操作，拥有自己独立的CPU以及存储单元，与主计算机之间以串行通信方式实现信息交互。•操作面板有各种操作按键】状态指示灯构成，只完成基本功能操作。•硬盘和软盘存储器存储机器人工作程序的外围存储器•数字和模拟量输入输出各种状态和控制命令的输入或输出。•打印机接口记录需要输出的各种信息•传感器接口由于信息的自动检测，实现机器人柔顺控制，一般为力觉、触觉和视觉传感器•轴控制器完成机器人各关节位置、速度控制•辅助设备控制用于和机器人配合的辅助设备控制，如手爪变位器等。•通讯接口实现机器人和其他设备的信息交换，一般有串行接口、并行接口等。•网络接口机器人位置控制•直角坐标位置控制：通过解逆运动方程，求出对应的直角坐标位姿的关节位移量，然后驱动伺服机构使末端执行器到指定的目标位置和姿态。1.点位式PTP(PointtoPoint）：只以终点位置为目标，作准确的移动，而对移动中的轨迹不作控制要求。典型的应用：spotWeldingrobot。5.1.2机器人的控制方式ACB2.轨迹式CP（ContinuousPath）:在任意特定数量的点处停留。点与点之间的轨迹不做要求—插补。典型的应用：ArcWeldingRobot。AB。如何插补？1qJX利用插补点之间的增量和雅可比逆矩阵,求出各关节的分增量各电机按照分增量进行位置控制。目标轨迹P(t)∆X3力（力矩）控制：装配、抓取工件等工作时，除了准确定位之外，还要求使用适度的力（力矩）。力（力矩）反馈---力传感器。4智能控制：AI技术（人工神经网络、遗传基因算法、模糊控制、专家系统等）。示教---即教机器人如何去做。在示教过程中，机器人将作业顺序、位置、速度等信息记录下来。再现----根据这些存储的信息再现示教的动作。5示教/再现（teaching/playback）控制-----一种主流控制方式：示教直接示教间接示教操作者使用安装在机器人手臂末端的操作杆（joystick）操作者使用示教盒(teachingbox)5.2单关节机器人模型与控制工业机器人运动速度不高(通常小于1.5m/s)，由速度项引起的非线性作用也可以忽略。工业机器人在驱动负载时通常需要减速器，其减速比往往接近100，这使得负载的变化（例如由于机器人关节角度的变化使得转动惯量发生变化）折算到电动机轴上要除以减速比的平方，因此电动机轴上负载变化很小，可以看作定常系统处理。各关节之间的耦合作用，也因减速器的存在而极大地削弱。工业机器人系统就变成了一个由多关节（多轴）组成的各自独立的线性系统。由于机器人是耦合的非线性动力学系统，严格说，各关节的控制必须考虑关节间的耦合作用，但通常：直流伺服电机的等价回路5.2.1单关节系统的数学模型RiLJ1B1J2B2121212/zznu直流伺服电动机驱动机器人关节的简化模型电机轴的转矩平衡方程为：)()()()(21121211tdttdBdttdJt负载轴的转矩平衡方程为：dttdBdttdJtn)()()(2222222)()()()(1tudttdktRidttdiLb)()(1tiktt电枢绕组电压平衡方程为：相互耦合方程为：微分方程忽略电感后得系统微分方程)()(21tnt再考虑到转角之间的关系：注：n电机经传动比：21/nzz)()()(22tukdttdBdttdJm电机轴的转动惯量J1和阻尼系数B1折算到负载侧时与传动比n2成正比；负载侧的转动惯量和阻尼系数向电机轴侧折算时要分别除以n2。)()(2tt式中：)(212JJnJRkknBBnBbt/)(2212Rnkktm/若采用传动比n1的减速机构，则负载的转动惯量和阻尼系数减少为原来的1/n2。------减速器的优点（与直接驱动相比）开环传递函数为：BsJsksUsm2)()(这一方程代表了单关节控制系统所加电压与关节角位移之间的传递函数。对于液压或气压传动系统，也可推出与上式完全类似的关系式，因此，此方程具有一定的普遍意义。机械传动系统的阻抗包括惯性阻抗（惯性质量的惯性矩，相当于电气系统中的线圈感抗）、摩擦阻抗（直线运动和旋转运动摩擦，相当于电气系统中的电阻）和弹性阻抗（弹簧和轴的扭转弹性变形，相当于电气系统中的电容器）。5.2.2阻抗匹配（略）在电气系统中，如果电源的内部阻抗与负载阻抗相同，那么负载消耗的电能最大，效率最高。在机械系统和流体传动系统中也有相似的性质。要从某一能源以最高效率获得能量，一般都要使负载的阻抗与能源内部的阻抗一致，这就叫阻抗匹配。即电机的惯性矩与负载的惯性矩相等，就会使执行装置达到最大的驱动能力。适当选择减速器的传动比，使执行装置的惯性矩与负载惯性矩一致。对于其它传动机构，采用不同的惯性矩变换系数也能得到同样的效果。212nJJ如果5.2.3单关节位置与速度控制1.P-Proportional/比例；I-Integral/积分；D-Derivative/微分)(t+-)(tdPIDControllerObjecte(t)u(t))()()()()(0adttdekdektektudtip操作量u(t))()()(1)()(0bdttdeTdeTtektudtip)(t+-Objecteu1+++)(tdsTi1sTdpkdipTTk,,分别为比例系数，积分时间，微分时间。比例（P）调节作用：按比例反映当前系统的偏差。系统一旦出现了偏差，比例调节立即产生调节作用用以减少偏差。积分（I）调节作用：是过去系统误差的积累。使系统消除稳态误差，提高无差度。因为有误差，积分调节就进行，直至无差，积分调节停止，积分调节输出一常值。微分（D）调节作用：反映未来系统偏差信号的变化率，具有预见性，能产生超前的控制作用。可以减少超调，减少调节时间，改善系统的动态性能。微分作用对噪声干扰有放大作用，因此过强的加微分调节，对系统抗干扰不利。PID控制的比例考虑的是现在的偏差值；积分考虑的是过去的偏差值；微分考虑的是未来偏差的变化量。并且以当前的误差为主，兼顾到了误差的过去与将来。可见，考虑问题之周全。PID控制是一种经典的控制方法PID控制的哲理----人生控制论P就是你现在的力量，要抓住现在，立足于现在；I表示了过去经验的积累，要不断地反思过去，从反思中取得经验；D是针对未来适应突变的能力，不断学习，提高自身的修养，增强对未来突变的适应能力。如果你能按PID控制人生，才能不受一些外面因素的干扰，把握好人生的方向，快速、平稳地达到追求的目标。PID控制器)(sd)(sBJsKms1)(sU)(sE)(s-+机器人单关节PID控制系统框图))()(())()(())()(()(D0IpdttddttdKdKttKtudtdd2.机器人单关节PID控制（闭环）举例：设电机参数如表所示惯性J4.7×10-4Kgm2电阻R12.3Ω力矩常数kT0.12Nm/A反电势常数ke4.87×10-3V/rpm粘性系数f21×10-5Nm/rpm用simulink进行PID控制仿真练习Kp=10,Ki=0.01,Kd=1Kp=20,Ki=0.01,Kd=1Kp=1,Ki=0,Kd=0仿真结果加入积分动作可消除系统的稳态偏差；加入微分动作后，比例和积分系数可增大，提高了系统的响应速度。222()()()2pmndpmnnkksssJsBkkssJkkBmp2二阶系统，参数均为正时，稳定，增大kp和阻尼，可减少误差。但上式可以看出kp增大，系统响应加快，但阻尼减小。有效方法是引入速度反馈pmnkkJ系统的闭环传递函数为（仅有比例时）位置+速度反馈在实际应用中，特别是机械系统中控制对象的库仑摩擦力小时，即使不用I动作也可得到非常好的控制性能。这种控制方法称为PD控制，其控制规律可表示为3.实用PID控制—PD控制))()(())()(()(DpdttddttdKttKtudd为了简化问题，考虑目标值为定值的场合ddttdKttKtud)())()(()(DpDKνK：速度反馈增益，通常用表示。位置+速度反馈闭环系统框图dttdKttKtud)())()(()(νp)(sd)(sBJsKms1)(sU)(sE)(s-+νKpK-系统的传递函数为Θ()Θ()()()Pm2dνmPmPm2νmPmKKssJsBKKsKKKKJBKKKKJssJJJkkkkBmpmv24.位置，速度反馈增益的选择自学，即引入速度反馈后，系统阻尼增大1时很明显：位置反馈增益变成了弹簧系数部分，即增大了系统的刚性；速度反馈增益变成了粘性摩擦系数的一部分，即增大了系统的阻尼。pmnkkJJkkBmp2原来TheEnd谢谢！