机器人学基础机器人控制蔡自兴PPT课件

1、Chapter 5 Robot Control第五章第五章 机器人控制机器人控制 5.1 Basic Principles of Robot Control 5.2 Position Control of Robots 5.3 Hybrid Control of Force/Position of Robots 5.4 Intelligent Control of Robots 5.5 Summary第1页/共57页RobotHuboMade in ChinaTrained in USA2Fundamentals of Robotics第2页/共57页HUBO Robot Hero，Im Hu

2、bo. I am a very unique robot. The more we play the more I can do! I can play games, dance and even sing to you! Lets be good friends!3Fundamentals of Robotics第3页/共57页ExamplesRobot HuBoPUMA 560Watch a video of BigDog第4页/共57页PUMA 560 Precise Universal Machine for Assembly An industrial robot第5页/共57页Ro

3、bot HuBo A mobile robot Designed in USA Made in China Can play games, dance and sing第6页/共57页Watch vedio BigDog Made by Boston Dynamics Co. US. A military robot which has amazing mobility and adaptability. It can climb up 35 slopes, carry more than 40 kg equipment.Impression: Kinem. + Dynam. + ?第7页/共

4、57页8Chapter 5 Robot Control5.1 Basic Principles of Robot Control 机器人的基本控制原则机器人的基本控制原则 The issue of robot control is closely related to robotic kinematics and dynamics. (how learn?). From the point view of control, The robotic system is a representative redundant, multi-variable and nonlinear control

5、 system in nature, and a complex coupling dynamic system. Every control task it self is a dynamical task. 机器人学基础第8页/共57页95.1 Basic Principles of Robot ControlClassification of Controllers non-servo control servo control position/speed feedback control force (torque) control Hybrid F-P control sensor

6、-based control nonlinear controlBasic Control Principles 5.1 Basic Principles of Robot Controladaptive controlhierarchical controloptimal controlfuzzy control neurocontrol other intelligent controls 第9页/共57页10 Industrial robot controller can be divided into single-joint (link) controller and multi-j

7、oint (link) controller. Robot control depends on its head, that the development of the processor. Various control methods can be used according to the actual working conditions.5.1 表机器人控制的分类及其分析方法5.1 Basic Principles of Robot Control第10页/共57页11 主要控制变量（Control Variables） Control variables of joints o

8、f a manipulator5.1 图机器手各关节控制变量5.1 机器人的基本控制原则第11页/共57页12控制层次 Control Levels Level 1： Level of AILevel 2 ： Level of control model Level 3 ： Level of servo system5.2 图机器手主要控制层次5.1 机器人的基本控制原则第12页/共57页 Robot control is the control of bidirectional equation: 末端执行装置的状态是由任务轴的许多参数表示的，它是机器人运动模型矢量X的分量。要控制矢量X 随

9、时间变化的情况，即 ，它表示末端执行装置在空间的实时位置。只有当关节移动时，X 才变化。用矢量 表示关节变量与受控量关系关节变量，即 至 。 各关节具有运动学模型C1至C6，这些模型构成关节矢量 ，并由各传动电动机的力矩矢量 经过变速机送到各个关节。在电流或电压矢量 提供的动力作用和微处理机的控制下，这些电动机产生力矩 。 )()()()()(tXttCtTtV )(tX( ) t 1)(tC)(tT)(tV)(tT6第13页/共57页14控制层次 Control Levels 1st Grade: Artificial Intelligence level2nd Grade: Control

10、 model level3rd Grade: Servo system-level5.2 图机器手主要控制层次5.1 Basic Principles of Robot Control第14页/共57页伺服控制系统举例伺服控制系统举例 Servo driven system of hydraulic cylinder155.1 机器人的基本控制原则5.3 图液压缸伺服传动系统结构图第15页/共57页 Electro-hydraulic servo control system165.4 -图电 液压伺服控制系统5.1 机器人的基本控制原则第16页/共57页17 Manipulator cons

11、ists of a series of links, whose dynamic characteristics are highly non-linear. We need to build up the mathematical model to control the motor-driven manipulator. Two assumptions in the designing of model: The manipulator is an ideal rigid body without friction and gap. Only one degree of freedom f

12、or each link, either translation or rotation. 5.2 Position Control of Robot 机器人的位置控制机器人的位置控制5.2 Position Control of Robot第17页/共57页18 直流传动系统的建模直流传动系统的建模n Transfer function and equivalent diagram 5.2 机器人的位置控制5.5图 直流电动机伺服传动原理第18页/共57页根据电力传动原理可求得下列传递函数： 电动机的开环传递函数，见式5.16 电枢控制直流电动机的传递函数(1)，见式5.23 )()()(2

13、KFSJSSlrkSVSffmfm)()()(memmmmmkkJSFSLRSkSVS第19页/共57页20 Speed regulation of DC motor5.2 机器人的位置控制5.8图 具有测速反馈的直流电动机控制原理图(a) 控制原理图(b) 等效电路图第20页/共57页21 Basic control structures Structure of Position Control 位置控制的基本结构位置控制的基本结构5.9图 机器人位置控制基本结构5.2 机器人的位置控制(a) 关节空间控制结构(b) 直角坐标空间控制结构第21页/共57页22Servo controlst

14、ructure of PUMA Structure of Position Control5.2 机器人的位置控制第22页/共57页23 Servo control structure for PUMA robot.9 PUMA图3 机器人的结构图 Structure of Position Control5.2 Position Control of Robot第23页/共57页24 Servo control structure for PUMA robot5.10 PUMA图 机器人的伺服控制结构 Structure of Position Control5.2 Position Con

15、trol of Robot第24页/共57页25单关节位置控制器单关节位置控制器nStructure of Position control system5.11图 斯坦福机械手的位置控制系统方框图5.2 Position Control of Robot第25页/共57页26 Transfer function of a single-joint controller5.12图 一个关节的电动机-齿轮-负载联合装置示意图)()()()(2IemmmmImmKkBRSBLJRJSLSKSVS(5.35)5.2 Position Control of Robot第26页/共57页275.13图

16、机械手位置控制器结构图5.2 Position Control of Robot第27页/共57页28 Determinate Parameters and the Steady-State Error (SSE) Steady-State Error (SSE)1KK,and tetIeffmKkKKBJRK/ )/(1ImeffKRJK4/2ILgfmsspKKCCCRe/ )(5.53)(5.55)(5.64)5.2 Position Control of Robot第28页/共57页多关节位置控制器多关节位置控制器29 Lagrangian dynamic equationniqLqL

17、dtdiii, 2 , 1,T616161ijkikjijkiaijijiDqqDqJqD T5.2 Position Control of Robot第29页/共57页5.2 Position Control of Robot30第30页/共57页多关节位置控制器多关节位置控制器31 Compensation of Coupled Inertia 耦合惯量补偿niqLqLdtdiii, 2 , 1,T616161ijkikjijkiaijijiDqqDqJqD T5.2 Position Control of Robot第31页/共57页325.3 Hybrid Position/Force

18、 Control of Robots 机器人的力和位置混合控制机器人的力和位置混合控制 Hybrid Position/Force Control 力和位置混合控制方案力和位置混合控制方案Active Stiffness Control主动刚性控制 如果希望在某个方向上遇到实际约束，那么这个方向的刚性应当降低，以保证有较低的结构应力；反之，在某些不希望碰到实际约束的方向上，则应加大刚性，这样可使机械手紧紧跟随期望轨迹。于是，就能够通过改变刚性来适应变化的作业要求。5.15图 主动刚性控制框图5.3 Hybrid Position/Force Control of Robot第32页/共57页3

19、3 Hybrid Control Raibert-Craig Position / Force Hybrid Controller 雷伯特雷伯特- -克雷格位置克雷格位置/ /力混合控制器力混合控制器5.16 R-C图 控制器结构5.3 Hybrid Position/Force Control of Robot第33页/共57页34Raibert-Craig Position / Force Hybrid Controller对R-C控制器进行如下改进：在混合控制器中考虑机械手的动态影响，并对机械手所受重力及哥氏力和向心力进行补偿； 考虑力控制系统的欠阻尼特性，在力控制回路中，加入阻尼反馈，

20、以消弱振荡因素。引入加速度前馈，以满足作业任务对加速度的要求，也可使速度平滑过渡。改进后的R-C力/位置混合控制系统结构图如图5.17所示。5.3 Hybrid Position/Force Control of Robot第34页/共57页355.17R-C图 改进后的混合控制系统结构5.3 Hybrid Position/Force Control of RobotRaibert-Craig Position / Force Hybrid Controller第35页/共57页36 Hybrid Control 操作空间力和位置混合控制系统5.18/图 操作空间力 位置混合控制系统框图5.

21、3 Hybrid Position/Force Control of Robot第36页/共57页 力和位置混合控制系统控制规律的综合力和位置混合控制系统控制规律的综合位置控制规律位置控制规律 Position Control Equation of the system controller:Dynamic Equation of a closed-loop system:Let37)(),()()()(qGqqCqqKqqKqqMTdppdpdd (5.67)0qKqKqpppd (5.70)IKIKnppnpd22(5.71)5.3 Hybrid Position/Force Contr

22、ol of Robot第37页/共57页38力控制规律力控制规律 Force Control令图5.17中的位置适从选择矩阵 S=0，控制末端在基坐标系z0方向上受到反作用力。设约束表面为刚体，末端受力如图5.19所示，那么对三连杆机械手进行力控制时有力控制选择矩阵：100000000S5.3.2 Control Rule Synthesis of Hybrid Sys.5.19图 机械手末端受力图5.3 Hybrid Position/Force Control of Robot第38页/共57页力控制规律力控制规律 Force ControlDynamic Equation of a cl

23、osed-loop system:Results show that on the force control joint 1 does not work, joints 2 and 3 are effective.39)()(0223333233233313233322223221dfdfddfdfdffHqKJJqKJqffHqKJJqKJqq (5.76)5.3 Hybrid Position/Force Control of Robot第39页/共57页40力和位置混合控制规律力和位置混合控制规律 Hybrid Control设约束坐标系与基坐标系重合。如果要求作业在基坐标系的z0方向

24、进行力控制，在某个与x0y0平面平行的约束面上进行位置控制，则适从选择矩阵为位置： 力： 000010001S100000000SfHJHJHJHJHJHJfHfHJzKzyKyKyxKxKxfdpppdpppd23313222312221311221322110 (5.84)5.3.2 Control Rule Synthesis of Hybrid Sys.5.3 Hybrid Position/Force Control of Robot第40页/共57页5.4 Intelligent Control of Robots 机器人的智能控制机器人的智能控制 智能控制系统的分类智能控制系统的

25、分类 递阶控制(Hierarchical Control) 专家控制(Expert Control) 模糊控制(Fuzzy Control) 学习控制(Learning Control) 神经控制(Neuro Control) 进化控制(Evolution Control) 415.4 Intelligent Control of Robot第41页/共57页5.4 Intelligent Control of Robots 机器人的智能控制机器人的智能控制 智能控制系统的分类智能控制系统的分类 递阶控制系统(Hierarchical Control System) 组织级代表控制系统的主导思

26、想，并由人工智能起控制作用。 协调级是上（组织）级和下（执行）级间的接口，承上启下，并由人工智能和运筹学共同作用。 执行级是递阶控制的底层，要求具有较高的精度和较低的智能，它按控制论进行控制，对相关过程执行适当的控制作用。425.4 Intelligent Control of Robot第42页/共57页Hierarchical Control System Structure of a hierarchical control system The control intelligence is hierarchically distributed according to the pri

27、nciple of increasing precision with decreasing intelligence (IPDI).435.20图 递阶智能机器的级联结构5.4 Intelligent Control of Robot第43页/共57页44 hierarchical control system of PUMA 600 with vision feedback.Hierarchically Control System5.21图 具有视觉反馈的机械手递阶控制结构5.4 Intelligent Control of Robot第44页/共57页45 专家控制系统专家控制系统(E

28、xpert Control System) Almost all of the expert control system (controller) contains the knowledge base(知识库), reasoning engineer (推理机), rule set (控制规则集) and/or control algorithm.5.22图 专家控制器的典型结构5.4 Intelligent Control of Robot第45页/共57页46 模糊控制系统模糊控制系统(Fuzzy Control System) A new mechanism of control l

29、aw of knowledge-based (rule-based) and even language-description. An improved alternative method to non-linear control.5.23图 模糊控制系统的基本结构5.4 Intelligent Control of Robot第46页/共57页47 学习控制系统学习控制系统(Learning Control System) Four main functions of learning control: search, recognition, memory and reasoning

30、.5.4 Intelligent Control of RobotOn-line learning control systemoff-line learning control system第47页/共57页48 神经控制系统神经控制系统(Neuro-Control System) Control system based on Artificial Neural Network (ANN-based control), abbreviate as neural control or NN control. 5.4 Intelligent Control of RobotSupervised

31、 neural controller structure第48页/共57页49 进化控制系统进化控制系统(Evolution Control System) Evolution and feedback are two basic regulatory mechanisms complementary to each other. Combination of the two mechanisms produces a new intelligent control method - evolutionary control. Evolutionary control simulate the

32、 evolution mechanisms of biosphere, improve the autonomy, creativity and learning ability of the system.5.4 Intelligent Control of Robot第49页/共57页505.4 .2 Adaptive Fuzzy Control of Robots 机器人的自适应模糊控制机器人的自适应模糊控制 Fuzzy control is the most widely used intelligent control method: The PID fuzzy control, s

33、elf-organizing fuzzy control, self-tuning fuzzy control, self-learning fuzzy control, expert fuzzy control, etc.5.26 ZebraZERO图 机器人模型5.27/图 附加力外环的机器人力 位置自适应模糊控制系统框图5.4 Intelligent Control of Robot第50页/共57页51 多指灵巧手的神经控制多指灵巧手的神经控制 Multi-fingered hand is also called multi-joint robot, generally made of a palm and 3 to 5 fingers, while each finger have 3 to 4 joints. Multi-fingered hand is smaller, with more degrees of freedom, and more flexible than normal robot. Multi-fingered hand get much stronger non-linear characteristic than o