机器人的分解运动控制课件.ppt

1、机器人控制机器人控制Control of Robotics6.1 6.1 机器人的基本控制原则机器人的基本控制原则 6.2 6.2 机械人的位置控制机械人的位置控制6.3 6.3 机械人的柔顺控制机械人的柔顺控制 6.4 6.4 机器人的分解运动控制机器人的分解运动控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法Robotics 控制6.1 6.1 机器人的基本控制原则机器人的基本控制原则 机器人控制特点：冗余的、多变量、本质非线性、耦合的6.1.1 基本控制原则1、控制器分类 结构形式：伺服、非伺服、位置反馈、速度反馈、力矩控制、 控制方式：非线性控制、分解加速度控制、最

2、优控制、自适应控制、滑模控制、模糊控制等 控制器选择：依工作任务，可选PLC控制、普通计算机控制，智能计算机控制等。 简单分类：单关节控制器：主要考虑稳态误差补偿； 多关节控制器：主要考虑耦合惯量补偿。Robotics 控制6.1 6.1 机器人的基本控制原则机器人的基本控制原则6.1.1 基本控制原则 一般分类：PLC、单片机、小型计算机、多计算机分布控制Robotics 控制6.1 6.1 机器人的基本控制原则机器人的基本控制原则6.1.1 基本控制原则2、主要控制变量 任务轴R0：描述工件位置的坐标系 X(t):X(t):末端执行器状态； (t):关节变量； C C(t)：关节力矩矢量；

3、 T(t)T(t)：电机力矩矢量； V V(t)：电机电压矢量本质是对下列双向方程的控制：)()()()()(tttttXCTVRobotics 控制6.1 6.1 机器人的基本控制原则机器人的基本控制原则6.1.1 基本控制原则3、主要控制层次 分三个层次：人工智能级、控制模式级、伺服系统级1）人工智能级 完成从机器人工作任务的语言描述 生成X X(t)； 仍处于研究阶段。2）控制模式级 建立X X(t) T T(t)之间的双向关系。 电机模型 传动模型 关节动力学模型 机器人模型)()()()(ttttTCX)()()()(ttttXCTRobotics 控制6.1 6.1 机器人的基本控

4、制原则机器人的基本控制原则6.1.1 基本控制原则3、伺服系统级 解决关节伺服控制问题即TV Robotics 控制6.1 6.1 机器人的基本控制原则机器人的基本控制原则6.1.2 伺服控制系统举例1、液压缸伺服传动系统 优点：减少减速器等，消除了间隙和磨损误差，结构简单、精度与电器传动相当。同样可以进行位置、速度、加速度及力的反馈。Robotics 控制6.1 6.1 机器人的基本控制原则机器人的基本控制原则6.1.2 伺服控制系统举例2、典型的滑阀控制液压传动系统Robotics 控制6.2 6.2 机器人的位置控制机器人的位置控制 由于机器人系统具有高度非线性，且机械结构很复杂，因此在

5、研究其动态模型时，做如下假设：（1）机器人各连杆是理想刚体，所有关节都是理想的，不存在摩擦和间隙；（2）相邻两连杆间只有一个自由度，或为旋转、或为平移。Robotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.1 直流传动系统的建模1、传递函数与等效方框图 伺服电机的参数：Robotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.1 直流传动系统的建模1、传递函数与等效方框图（1）磁场型控制电机22222,ccmcmmmmmfmmfffffkKffFJJJKdtdFdtdJTikTdtdilirvRobotics 控制6.2 6.2 机器人的位置控制机器

6、人的位置控制6.2.1 直流传动系统的建模1、传递函数与等效方框图 Laplace变换得：)()()()()()()()(2sKFsJssTsIksTsIslrsVmmfmmffff)()()(2KFsJsslrksVsffmfmRobotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.1 直流传动系统的建模1、传递函数与等效方框图一般可取 K K=0，则有等效框图同时，传递函数变为Robotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.1 直流传动系统的建模1、传递函数与等效方框图 ：电气时间常数； ：机械时间常数。)1)(1 ()1)(1 (1)(

7、)()(0sssksFJsrlsFrkFJsslrsksVsmefffmffmfmmeRobotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.1 直流传动系统的建模1、传递函数与等效方框图由于 ，有时可以忽略，于是而对角速度的传递函数为： ，因为me)1 ()()(0ssksVsmfmsksVsmfm1)()(0dtdmmRobotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.1 直流传动系统的建模1、传递函数与等效方框图（2）电枢控制型电机K Ke:产生反电势。22222,ccmcmmmmmmmmmemmmmmkKffFJJJKdtdFdtdJTi

8、kTkdtdiLiRVRobotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.1 直流传动系统的建模1、传递函数与等效方框图 经拉氏变换、并设K K=0，有memmmmmkkJsFsLRsksVs)()()(Robotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.1 直流传动系统的建模2、直流电机的转速调整误差信号：)()()(0ttteiRobotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.1 直流传动系统的建模2、直流电机的转速调整 比例补偿：控制输出与e(t)成比例； 微分补偿：控制输出与de(t)/dt成比例； 积分补

9、偿：控制输出与e(t)dt成比例； 测速补偿：与输出位置的微分成比例。比例微分PD补偿：比例积分PI补偿：比例微分积分PID补偿：测速补偿时：)()()(sEsksEd)()()(sEsksEi)()()(sEsksEid)()1 ()()()()(00ssssssEsEtitRobotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.2 位置控制的基本结构1、基本控制结构 位置控制也称位姿控制、或轨迹控制。分为： 点到点PTP控制；如点焊； 连续路径CP控制；如喷漆 期望的关节位置 期望的工具位置和姿态Tdndddqqqq21,TdTddpwRobotics 控制6.2 6

10、.2 机器人的位置控制机器人的位置控制6.2.2 位置控制的基本结构2、PUMAPUMA机器人的伺服控制结构 1）机器人控制系统设计与一般计算机控制系统相似。 2）多数仍采用连续系统的设计方法设计控制器，然后再将设计好的控制律离散化，用计算机实现。 3）现有的工业机器人大多数采用独立关节的PID控制。 下图PUMA机器人的伺服控制系统构成 Robotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.2 位置控制的基本结构2、PUMAPUMA机器人的伺服控制结构 Robotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.3 单关节位置控制器1、位置控制系统结

11、构具有力、位移、速度反馈 Robotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.3 单关节位置控制器1、位置控制系统结构 控制器路径点的获取方式： （1）以数字形式输入系统；若以直角坐标给出，须计算获 得其关节坐标位置。 （2）以示教方式输入系统；系统将直接获得关节坐标位置 允许机器人只移动一个关节，而锁住其他关节。 轨迹控制： 按关键点或轨迹进行定位控制。Robotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.3 单关节位置控制器2、单关节控制器的传递函数 对图示系统，有J J：等效转动惯量；B B：等效阻尼系数。lmlmammmBBBJJJJB

12、JT22 Robotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.3 单关节位置控制器2、单关节控制器的传递函数 因此可得其传递函数（同电枢控制直流伺服电机） )()()()(2IemmmmImmKkBRsBLJRJsLsKsVs)()()()()()()()(ttKtVtttttesdmmssd)()()()()()()()(ssKsVsssssEsdmmssdRobotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.3 单关节位置控制器2、单关节控制器的传递函数 Robotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.3 单关

13、节位置控制器2、单关节控制器的传递函数 其开环传递函数为：因为： ，略去Lm的项，简化上式为：)()()()(2IemmmmIsKkBRsBLJRJsLsKKsEs,mmRL )()()(IemmIsKkBRJsRsKKsEsRobotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.3 单关节位置控制器2、单关节控制器的传递函数 则其闭环传递函数为：这是一个典型的二阶系统闭环传递函数。)()()(1)()(1)()()()(2JRKKJRskKBRsJRKKsEssEsssmmeImmIssdsRobotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.3

14、 单关节位置控制器2、单关节控制器的传递函数 Robotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.3 单关节位置控制器2、单关节控制器的传递函数 含有速度反馈的机械手单关节控制器的开环传递函数为 闭环传递函数为sKKKKkBRJsRKKsEstIIemmIs)()()(12ItIeImmIssdsKKsKKKkKBRJsRKKsEssEsss)()()(1)()()()(12Robotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.3 单关节位置控制器3、控制参数确定与稳态误差（1） 的确定由上述闭环传递函数，得控制系统的特征方程为： 将其写为二阶

15、系统标准形式得1/ KK0)(12ItIeImmKKsKKKkKBRJsR0222nnssJRKKKKkKBRJRKKmIteImmIn2/)(0/1Robotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.3 单关节位置控制器3、控制参数确定与稳态误差（1） 的确定1/ KKRobotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.3 单关节位置控制器3、控制参数确定与稳态误差（1） 的确定1/ KKRobotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.3 单关节位置控制器3、控制参数确定与稳态误差（1） 的确定 设结构的共振频

16、率为 ，则为避免运动中发生共振，要求同时要求系统阻尼大于1，J值随负载和位姿变化，应选可能的最大惯量。 rImrrmInKJRKJRKK4,2/2tetIrmmIteImKkKKBJRKJRKKKKkKBR/ )/(12/)(111/ KKRobotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.3 单关节位置控制器3、控制参数确定与稳态误差（2）稳态误差 根据控制理论，在控制系统框图中，计算得到E(s),即可得到系统的稳态位置误差、速度误差和加速度误差。对于单位阶越位移C C0，其稳态误差为 )(lim)(lim0ssEteestssILgfmsspKKCCCRe/ )(

17、Robotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.4 多关节位置控制器 1）为快速运动，一般应采用多关节协调、同步运动。 2）这时各关节的位置和速度会互相作用，因此，必须进行附加补偿。1、动态拉格朗日公式 其他关节加速 自身加速 科式力 重力且D项皆与关节角有关。 ijkkjijkiaiijijiDqqDqJqDT616161 Robotics 控制6.2 6.2 机器人的位置控制机器人的位置控制6.2.4 多关节位置控制器 Robotics 控制6.3 6.3 机器人的柔顺控制机器人的柔顺控制6.3.1柔顺控制的基本概念 柔性无刚性作用的运动控制。 如擦玻璃、抓鸡

18、蛋、装配等 一般应增加力反馈。Robotics 控制6.3 6.3 机器人的柔顺控制机器人的柔顺控制6.3.1柔顺控制的基本概念1、被动柔顺和主动柔顺 被动柔顺：通过弹簧、消振器等机械结构或通过改变机械操 作方式而使机器人与工作对象间产生相对柔性运 动的柔顺方式。（无须控制器参与） 如：1）海绵擦玻璃，2）把工件拉进孔取代推入 主动柔顺：通过改变控制器控制方式，增加力反馈等使机器 人与工作对象间无刚性运动的柔顺方式。（必须 控制器参与）Robotics 控制6.3 6.3 机器人的柔顺控制机器人的柔顺控制6.3.1柔顺控制的基本概念1、被动柔顺和主动柔顺 定义： ：在工作点的小位移； ：工作点

19、的关节小位移 ：正定对角刚度矩阵 ：机器人雅可比矩阵 ：回复力 ：关节力矩 定义关节刚度矩阵： ，反应力矩与微位移关系FJKqxpqJKJqJxFJxKFpTTp)( JKJKpTqRobotics 控制6.3 6.3 机器人的柔顺控制机器人的柔顺控制6.3.1柔顺控制的基本概念2、作业约束和力控制 自然约束与人为约束Robotics 控制6.3 6.3 机器人的柔顺控制机器人的柔顺控制6.3.1柔顺控制的基本概念2、作业约束和力控制 约束对机器人力控制的影响：1）约束使自由度减少，限制了末端的运动方式；2）约束给机器人增加了作用力，增加了控制的复杂程度；3）上述两种情况会相互作用 Robot

20、ics 控制6.3 6.3 机器人的柔顺控制机器人的柔顺控制6.3.1柔顺控制的基本概念3、柔顺控制的种类 1）阻抗控制 通过控制力和位置间的动态关系（阻抗），来实现柔顺功能。即：通过控制使机械手末端呈现所需要的刚性和阻尼。 需要位置控制的自由度，需要大的刚性； 需要力控制的自由度，需要小的刚性。 2）力和位置混合控制 将控制分为一些自由度的位置控制，和另一些自由度的力控制，通过计算，在关节空间合并，进行关节控制。Robotics 控制6.3 6.3 机器人的柔顺控制机器人的柔顺控制6.3.2 主动阻抗控制1、位置型阻抗控制 ：估计重力矩 ：雅可比矩阵 ：机械手等效刚度比例系数 ：机械手等效阻

21、尼系数教材中的稳定性讨论，内容不全，这里省略。)()( xKxKqJqgxxxDpTdDpKKqJqg)()(Robotics 控制6.3 6.3 机器人的柔顺控制机器人的柔顺控制6.3.2 主动阻抗控制2、柔顺型阻抗控制 ：接触引起的环境变形 ：接触时 ：不接触时 环境作用于机械手的力为： 0EEEExxxxxEEExKFRobotics 控制6.3 6.3 机器人的柔顺控制机器人的柔顺控制6.3.3 力和位置混合控制 Kp:刚性对角矩镇阵，可以通过对其元素的修改，适应不同方向的刚性要求，达到柔顺目的。Robotics 控制6.3 6.3 机器人的柔顺控制机器人的柔顺控制6.3.3 力和位置

22、混合控制 Robotics 控制6.3 6.3 机器人的柔顺控制机器人的柔顺控制6.3.3 力和位置混合控制 Robotics 控制6.4 6.4 机器人的分解运动控制机器人的分解运动控制6.4.1 分解运动控制原理 将机械手末端运动分解为沿笛卡儿坐标的运动的形式，分别用各关节的综合运动合成为沿笛卡儿坐标的运动。 主要是针对夹持器的坐标进行讨论。 10)(1000)()()()()()()()()()()()()()(6060tpRtptatotntptatotntptatotntTtzzzzyyyyxxxxRobotics 控制6.4 6.4 机器人的分解运动控制机器人的分解运动控制6.4.

23、1 分解运动控制原理 用俯、仰、滚表示夹手的姿态： 可以定义夹手的位置、姿态、线速度、角速度矢量为：cssccssccssctptotntptotntptotntRzzzyyyxxx000010010010000)()()()()()()()()()(60TzyxTzyxTTzyxtttttvtvtvtvtttttptptptp)(),(),()()(),(),()()(),(),()()(),(),()(Robotics 控制6.4 6.4 机器人的分解运动控制机器人的分解运动控制6.4.1 分解运动控制原理 线速度： 角速度：)()()(tpdttdptv000000sccccssccsc

24、cssRdtdRdtdRRxyxzyzTTRobotics 控制6.4 6.4 机器人的分解运动控制机器人的分解运动控制6.4.1 分解运动控制原理 即： 求逆，得即)()()(1000)()()(tttsccsscctttzyx)()()(00sec)()()(tttcsssccccssctttzyx)()()(tStRobotics 控制6.4 6.4 机器人的分解运动控制机器人的分解运动控制6.4.1 分解运动控制原理 根据雅可比矩阵定义，有若逆雅可比矩阵存在，则有， 这是分解速度控制的基础。 )()()()()()()()(621tqqJqJqJtqqJttv)()()()(1ttvq

25、Jtq Robotics 控制6.4 6.4 机器人的分解运动控制机器人的分解运动控制6.4.1 分解运动控制原理 对于加速度有： 从而有：这是分解加速度控制的基础。)()()()()(),()()()(),()()(1tqqJttvqJqqJtqqJtqqqJttv )()()(),()()()()()(111ttvqJqqJqJttvqJtq Robotics 控制6.4 6.4 机器人的分解运动控制机器人的分解运动控制6.4.2 分解运动速度控制 分解运动速度控制，各关节电机联合运行，保证夹手沿笛卡儿坐标稳定运动。 先把夹手运动分解为各关节的期望速度，然后对各关节实行速度伺服控制。 Tn

26、Tzyxqqqtqppptxtqftx21)()()()()()()()(tqqJtxdttdxRobotics 控制6.4 6.4 机器人的分解运动控制机器人的分解运动控制6.4.2 分解运动速度控制 当m=n，机械手非冗余时，有当mn，机械手为冗余，需要用广义逆：mjniqfJiiij1 ,1 ,)()()(1txqJtq)()()()()(111txqJAqJqJAtqTTRobotics 控制6.4 6.4 机器人的分解运动控制机器人的分解运动控制6.4.3 分解运动加速度 分解运动加速度控制：首先计算出工具的笛卡儿坐标加速度，然后将其分解为相应的各关节加速度，再按照动力学方程计算出控

27、制力矩。 实际位置和姿态 期望的位置和姿态位置误差姿态误差1000)()()()()(tptatotntH1000)()()()()(tptatotntHddddd)()()()()()()()()(tptptptptptptptptezdzydyxdxdpdddataotontnte)()()(21)(0Robotics 控制6.4 6.4 机器人的分解运动控制机器人的分解运动控制6.4.2 分解运动速度控制 为减少位置和姿态误差，要求因为)(),()()()()()()()()(tqqqJtqqJtxtqqJttvtx )()()()()()()()()()(2121tekttktttek

28、tvtvktvtvoddpdd)()()(,)()()(tetetettvtxopdddRobotics 控制6.4 6.4 机器人的分解运动控制机器人的分解运动控制6.4.2 分解运动速度控制 从而有： 代入得：因为这里考虑的是误差项，因此是闭环控制，精度高。)()()()()(21tektxtxktxtxdd )(),()()()(tqqqJtqqJtx )(),()()()()()()(2111tqqqJtektxktxqJtqktqdd Robotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.1 机器人关节控制的PID算法 如果机器人的关节位置误差

29、为： 则其PID控制为 qqed)(1)()()()(00eTdeTektekdektektuDtIPDtIPRobotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.1 机器人关节控制的PID算法 ：比例系数；控制量中，减小误差的直观比例部分 ：微分系数；提高响应速度，相位超前；使系统趋于稳定； ：积分系数；提高稳态精度，相位滞后；使系统趋于不稳定 ：积分时间； ：微分时间； DIDIPTTkkkRobotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.1 机器人关节控制的PID算法微分超前型PD控制：积分项在使用中，经

30、常出现饱和，有时会使系统不稳定，因此常常使用PD控制。其控制律为 xkekekektuDPDP)(Robotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.2 模糊集合与模糊逻辑的基本概念一、模糊集合与集合计算符 定义1 模糊集合：设U为若干事件的总和，如U=Rn，我们称U为论域，一个定义在U上的模糊集合F，由隶属度函数 来表征，这里的 表示 在模糊集合F上的隶属程度。 经典的集合（确定集合）的隶属度函数只取两个值0,1。要么属于，要么不属于。因此模糊集合是经典集合的推广。1 , 0:UF)(uFUuRobotics 控制6.5 6.5 机器人关节控制的模糊

31、算法机器人关节控制的模糊算法6.5.2 模糊集合与模糊逻辑的基本概念定义2 交集、并集和补集：设A和B是U上的两个模糊集合。对所有的 ，A和 B的交集是定义在U上的一个模糊集合，其隶属度函数定义为：对所有的 ，A和B的并集是定义在U上的一个模糊集合，其隶属度函数定义为：对所有的 ，A的补集是定义在U上的一个模糊集合，其隶属度函数为：Uu)(),(min)(uuuBABAUu)(),(max)(uuuBABAUu)(1)(uuAARobotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.2 模糊集合与模糊逻辑的基本概念定义3 模糊关系 设U和V是两个论域。模糊

32、关系R是积空间UxV上的一个模糊集合，即当 时，R的隶属函数为 . 定义4 模糊蕴涵 设A和 B分别为定义在U和V上的模糊集合,则由 所表示的模糊蕴涵是定义在UxV上的一个特殊模糊关系,其隶属度函数定义为:模糊与:模糊或:实质蕴涵:命题演算:VvUu,),(vuRBA)()(),()()(),()()(),()()(),(vuvuvuvuvuvuvuvuBAABABABABABABABARobotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.2 模糊集合与模糊逻辑的基本概念定义5 广义取式推理: 前提1 x为A 前提2 如果x为A,则y为B 结论 y为B

33、其中A、A、B、B为模糊集合，x、y为语言变量定义6 广义取式推理: 前提1 y为B 前提2 如果x为A,则y为B 结论 x为A其中A、A、B、B为模糊集合，x、y为语言变量)()( 1 , 0inf),(vcucvuABBA)()( 1 , 0sup),(vcucvuBABARobotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.3 模糊规则与模糊推理模糊规则是由如下形式的“如果-则”规则的总和组成R（l）：如果x1为F1l ，且，且xn为Fnl，则y为Gl； Fil 、Gl为模糊集合， xi为模糊变量。将变量模糊化后，经过按照模糊规则的运算，获得模糊结

34、果，这个过程称为一个模糊推理。模糊推理得到的模糊输出，再经过反模糊化，即可得到模糊推理的精确解。Robotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.2 模糊集合与模糊逻辑的基本概念定义5 广义取式推理: 前提1 x为A 前提2 如果x为A,则y为B 结论 y为B 其中A、A、B、B为模糊集合，x、y为语言变量定义6 广义取式推理: 前提1 y为B 前提2 如果x为A,则y为B 结论 x为A其中A、A、B、B为模糊集合，x、y为语言变量)()( 1 , 0inf),(vcucvuABBA)()( 1 , 0sup),(vcucvuBABARobotics

35、 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.3 模糊规则与模糊推理模糊规则是由如下形式的“如果-则”规则的总和组成R（l）：如果x1为F1l ，且，且xn为Fnl，则y为Gl； Fil 、Gl为模糊集合， xi为模糊变量。将变量模糊化后，经过按照模糊规则的运算，获得模糊结果，这个过程称为一个模糊推理。模糊推理得到的模糊输出，再经过反模糊化，即可得到模糊推理的精确解。Robotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.4 模糊控制工作原理一个典型的模糊控制系统 Robotics 控制6.5 6.5 机器人关节控制的模糊算

36、法机器人关节控制的模糊算法6.5.4 模糊控制工作原理例：一热处理用的电热炉，按工艺要求须保持炉温600O不变。由于炉温受零件数量、体积、环境温度变化、电网电压波动等影响，会出现波动所以要设计控制器。控制方式：通过改变可控硅的导通角实现；也可以通过PWM方式 调节。人工调节时，通过面板上的电位器实现，计 算机调节通过驱动线路实现。 Robotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.4 模糊控制工作原理典型的温度控制电路如图 INT1，INT2过零检测，PB7触发控制，AN0传感器输入A/D。Robotics 控制6.5 6.5 机器人关节控制的模糊算

37、法机器人关节控制的模糊算法6.5.4 模糊控制工作原理 人工操作时，根据经验，控制规则可以用语言描述如下： 如果炉稳低于600OC则升压，低得越多升压越高； 如果炉稳高于600OC则降压，高得越多降压越低； 如果炉稳等于600OC则保持电压不变；采用模糊控制时，其工作原理如下：1、模糊控制器的输入变量与输出变量 设定炉温t0=600，测量炉稳t（K），则将误差e(K)=t0-t(K)作为模糊控制的输入变量。 输出变量为：控制电压u，可通过改变可控硅的导通角或PWM比例实现。Robotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.4 模糊控制工作原理2、输入

38、变量及输出变量的模糊语言描述（模糊化）设描述输入及输出变量的语言值的模糊子集为： 负大，负小，0，正小，正大 或记为 NB，NS，0，PS，PB 设误差e的论域为X，并将误差大小分为七个等级，为：-3，-2，-1，0，1，2，3，则有：X=-3，-2，-1，0，1，2，3选控制变量u的论域为Y，并将其也分为七个等级，为：-3，-2，-1，0，1，2，3，则有：Y=-3，-2，-1，0，1，2，3定义其隶属度函数如图：Robotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.4 模糊控制工作原理 由此得模糊变量赋值表：Robotics 控制6.5 6.5 机器

39、人关节控制的模糊算法机器人关节控制的模糊算法6.5.4 模糊控制工作原理3、模糊控制规则的语言描述 根据手动控制策略，规则为：（1）若e负大，则u正大；（2）若e负小，则u正小；（3）若e为零，则u为零；（4）若e正小，则u负小；（5）若e正大，则u负大；由此可得控制规则表：eNBNS0PSPBuPBPS0NSNBRobotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.4 模糊控制工作原理4、模糊控制规则的矩阵形式 模糊控制规则实际上是从误差论域X到控制量论域Y的模糊关系R，可记为：从模糊赋制值表可得：)()()()()(ueueueueueNBPBNSP

40、SOOPSNSPBNBR000000000000000000000000000000000005.05.00000015.000000)1,5.0,0,0,0,0,0()0,0,0,0,0,5.0,1(uePBNBRobotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.4 模糊控制工作原理 通理，可以得到将这些代入求和式，有ueueueueNBPBNSPSOOPSNS000005 . 0100005 . 05 . 05 . 0005 . 05 . 015 . 00005 . 015 . 00005 . 015 . 05 . 0005 . 05 . 05 .

41、 0000015 . 000000RRobotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.4 模糊控制工作原理5、模糊决策 当模糊输入为e（K）时，其对应的输出为 u（K）=e（K）。R例如，当e（K）=PS时，6、模糊输出变为精确值（1）隶属度最大原则，则u=-1；（2）平均法：005.05.015.05.0)()(RKeKu73001*5 .00*5 .0)1(*1)2(*5 .0)3(*5 .071uRobotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.4 模糊控制工作原理7、模糊控制表 上述的结果即可用于实际控制，但是，为了提高控制速度，一般将各种情况预先计算出，存入表中，形成模糊控制表。输入量和输出量的值，可以自行定义，如定义-3=550OCe -3 -2 -1 0123u 3210 -1 -2 -3Robotics 控制6.5 6.5 机器人关节控制的模糊算法机器人关节控制的模糊算法6.5.5 机器人关节位置的模糊控制 我们可以将上述温度变量换为机器人的关节角度，将误差定义为期望转角与实测转角的差，输出定义为关节控制电压，即可实现机器人关节角位置的模糊控制。