版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
1、基于声音的舵机机器人的运动控制分析摘 要:舵机是一种位置伺服的驱动器,由于这种机器具有重量轻,体积小,精度高扭矩大等优点,因此很适合应用在机器人上作为机器人的驱动。基于声音控制的舵机机器人是研究舵机机器人的一个重要方面。本文以舵机机器人为研究对象,以声音控制系统为主线,从多个方面对基于声音的舵机机器人运动控制作了系统的研究。 本文从提高舵机机器人运动控制的实时性出发,应用Bioloid机器人套件,采用PoboPlus软件,设计了基于声音控制的舵机机器人。使用CM-530控制器使得舵机机器人的运动控制得以实现。设计包括了舵机机器人的硬件组装、PID控制算法的分析、控制程序的编写、运动过程的分析等
2、过程。关键词:舵机机器人,运动控制,PoboPlus,PID The analyze based on sound on the motion control of the servo robotAbstract: The steering engine is a position servo driver, and its suitable for application in robot as a robot driver because of its light quality, small volume, high accuracy and large torque. The serv
3、o robot based on the sound control is an important aspect of researching servo robot. This paper systemically researches the motion control of servo robot based on the sound control from many aspects with the servo robot being the object and sound control system being the main line.This paper also a
4、pplies the Bioloid robot kits and uses the PoboPlus software to design the servo robot based the sound control from the point of improving the instantaneity of the servo robot. Using the CM - 530 controller makes the achievement of servo motion control of robot. The design includes the assembling of
5、 servo robot, analysis of PID control algorithm, the writing of control program and the analysis of motion process.Keywords: servo robot, motion control, PoboPlus, PID目 录 TOC o 1-3 h z u HYPERLINK l _Toc421624575 1 绪论 PAGEREF _Toc421624575 h 1 HYPERLINK l _Toc421624576 1.1选题的背景及意义 PAGEREF _Toc421624
6、576 h 1 HYPERLINK l _Toc421624577 1.2Bioloid概述 PAGEREF _Toc421624577 h 1 HYPERLINK l _Toc421624578 1.2.1 Bioloid硬件介绍 PAGEREF _Toc421624578 h 2 HYPERLINK l _Toc421624579 1.2.2 Bioloid软件介绍 PAGEREF _Toc421624579 h 3 HYPERLINK l _Toc421624580 1.3本文章节安排 PAGEREF _Toc421624580 h 6 HYPERLINK l _Toc421624581
7、 2 舵机机人控制系统硬件设计 PAGEREF _Toc421624581 h 8 HYPERLINK l _Toc421624582 2.1电子元器件选择 PAGEREF _Toc421624582 h 8 HYPERLINK l _Toc421624583 2.1.1控制器的选择 PAGEREF _Toc421624583 h 8 HYPERLINK l _Toc421624584 2.1.2舵机的选择 PAGEREF _Toc421624584 h 10 HYPERLINK l _Toc421624585 2.1.3其他元件的选择 PAGEREF _Toc421624585 h 10 H
8、YPERLINK l _Toc421624586 2.2舵机机器人控制系统设计 PAGEREF _Toc421624586 h 11 HYPERLINK l _Toc421624587 2.3舵机机器人组装 PAGEREF _Toc421624587 h 11 HYPERLINK l _Toc421624588 2.4本章小结 PAGEREF _Toc421624588 h 13 HYPERLINK l _Toc421624589 3 舵机的结构及其控制原理 PAGEREF _Toc421624589 h 13 HYPERLINK l _Toc421624590 3.1舵机的内部结构 PAGE
9、REF _Toc421624590 h 13 HYPERLINK l _Toc421624591 3.2舵机的工作原理 PAGEREF _Toc421624591 h 14 HYPERLINK l _Toc421624592 3.3 AX-12+舵机的控制 PAGEREF _Toc421624592 h 15 HYPERLINK l _Toc421624593 3.4本章小结 PAGEREF _Toc421624593 h 15 HYPERLINK l _Toc421624594 4 舵机机器人的速度控制 PAGEREF _Toc421624594 h 15 HYPERLINK l _Toc4
10、21624595 4.1引言 PAGEREF _Toc421624595 h 15 HYPERLINK l _Toc421624596 4.2数字PID控制算法 PAGEREF _Toc421624596 h 16 HYPERLINK l _Toc421624597 4.3基于数字PID的机器人速度控制 PAGEREF _Toc421624597 h 18 HYPERLINK l _Toc421624598 4.3.1PID控制的MATLAB仿真 PAGEREF _Toc421624598 h 19 HYPERLINK l _Toc421624599 4.4本章小结 PAGEREF _Toc4
11、21624599 h 23 HYPERLINK l _Toc421624600 5 舵机机人控制系统软件设计 PAGEREF _Toc421624600 h 23 HYPERLINK l _Toc421624601 5.1 RoboPlus Task程序的编写 PAGEREF _Toc421624601 h 23 HYPERLINK l _Toc421624602 5.2RoboPlus Motion程序的编写 PAGEREF _Toc421624602 h 27 HYPERLINK l _Toc421624603 5.3本章小结 PAGEREF _Toc421624603 h 29 HYPE
12、RLINK l _Toc421624604 6 总结与展望 PAGEREF _Toc421624604 h 29 HYPERLINK l _Toc421624605 6.1总结 PAGEREF _Toc421624605 h 29 HYPERLINK l _Toc421624606 6.2展望 PAGEREF _Toc421624606 h 29 HYPERLINK l _Toc421624607 参考文献 PAGEREF _Toc421624607 h 31 HYPERLINK l _Toc421624608 致 谢 PAGEREF _Toc421624608 h 33 HYPERLINK
13、l _Toc421624609 附 录 PAGEREF _Toc421624609 h 34太原工业学院毕业设计1 绪论1.1选题的背景及意义随着机器人的技术和微型计算机控制技术的快速速发展,机器人技术在全世界得到了广泛的应用,几乎所有的领域都有计算机的参与。机器人的发展大致经过三代的演变1:第一代的机器人是“示教再现型”,这类机器人只拥有记忆、存储能力,但却没有反馈控制能力;第二代机器人是具有一定感觉功能和自适应能力的离线编程机器人;第三代机器人是具有外部环境和对象感知能力的,它不但可以处理外部复杂的信息,而且可以对自己行为作出自主决策能力。第三代机器人通常装有多种传感器,能够对外部信息进行
14、处理。当前,实现机器人的运动控制过程还是依靠传统的键盘输入,即使是有一些机器人已经开始使用视觉控制技术,但是由于受到视线和能见度的局限,在光线条件不良或者障碍物阻挡的情况下,视觉控制就会失效。在这种情况下,听觉系统作为人类感官的重要组成部分,为机器人感知技术的研究提供了新的思路。声音控制技术就是通过模拟人耳听觉机制的模拟,利用声学传感装置接收外界传来的声波,再通过特定的装置将声音信号进行处理,从而实现声源位置探测、识别以及目标定位及跟踪。20世纪80年代以来,声音控制技术依靠其极强的隐蔽性、良好的适用性、低成本等独特优点,渐渐受到世界各国的重视,在民用与军用上都有十分广的应用,如在海战场水下目
15、标感知和战场排雷等危险环境作业中应用等2。综上所诉,人们可以利用声音控制技术对机器人进行运动控制,研究基于声音的机器人控制系统。机器人的声音控制技术将近一步推动机器人的应用范围,具有广阔的前景和研究意义。 1.2Bioloid概述Bioloid,是一种全方位的机器人套件,能够依据使用者想法,来组装出各种形态。Bioloid机器人套件的优点是可以组装出各种实体型态,也可以无限扩充,并提供程序设计界面、控制器、智慧伺服马达与感测模块;透过整合应用,帮助设计出机器人行为。 图1.1 Bioloid机器人套件1.2.1 Bioloid硬件介绍硬件架构主要分为CM-530、AX-12+、各感应器、框架和
16、线材。还有连接线、扩充版、外部传感器、转接器、无线传输模块等一些额外配件。CM-530是Bioloid套件中的核心,用来连接 Dynamixels系列(AX-12+、AX-S1、AX-20等等)以及OLLO组件(Geared Moto BOX、Touch Sensor、LED Module、IR Sensor,etc)和周边设备(包含各种感应器)。可以使用RoboPlus Motion(动作编辑)编辑和存储特定动作。可以利用RoboPlus Task(行为控制)执行已储存的动作档(mtn文件)。也可以写入任务程序来控制每个组件动作。AX-12+ 智能型马达,作为机器人的运动关节。内建了微控器,
17、可以控制速度、旋转位置感测温度读取设定值等。除此之外当马达旋转超出当前预设的安全范围(温度过高、过载或其他错误情况),会自动关闭以避免损坏,并发出声音警告使用者。框架组包括框架、线缆、螺丝、螺帽、轴承、和轮圈等等,能将CM-530和AX-12+衔接起来。各感应元件:(1)红外线物体传感器,感测方法是利用红外线反射来取得距离数据红外线适合计算所距距离。因为即使在相同距离下,只要光线、彩、亮度不同,反射数据也会大不同。(2)距离传感器,用于探测物体或距墙壁固定的距离,不受颜色所影响的红外线距离传感器,可以感应更准确的距离。1.2.2 Bioloid软件介绍RoboPlus中拥有RoboPlus T
18、ask(行为控制)、 RoboPlus Motiom(动作编辑)、 RoboPlus Manager(硬件管理)三部分。RoboPlus Task通常被用来设计机器人在面对某种事件时所产生的反应,这种反应根据传感器所测得的各项数据来做判断,RoboPlus Task使用的编程语言是一种类C语言的程序,其中主要用来透过CM-530等控制器来控制周边马达或传感器,程序内部已经将大多数周边配备编写成的一个个的函数库,必要时只需要呼叫函数或者变量即可完成操作,有C语言基础将会更容易使用RoboPlus Task。行为控制逻辑是衔接输入与输出之间关系的,输入好比人类的五官,耳朵、眼睛、触觉等(AX-S1
19、传感器)以及其他的零组传感器;而大脑(CM-530控制器)接收到外在资料根据情况作出适合的反应,对机器人来说这就是输出。行为控制逻辑就是以逻辑思考的方式,来控制输入输出的。 图1.7 RoboPlus Task工作界面RoboPlus Motiom最大的功能就是简化程序的编写,一次控制多样马达,一次进行多样马达的动作,一次进行连续动作。行为控制(RoboPlus Task)可以轻而易举的控制数量不多的马达,但到了15、16个以上的马达数量,将会控制不易,但动作编辑(RoboPlus Motiom)能够简单的实现控制多样马达,并且达到连续动作。使用方法就是用动作编辑(RoboPlus Motio
20、m)设计好的动作再经由行为控制(RoboPlus Task)来进行使用,就可以达到所需动作或感应。Motiom包含了动作页面、动作旗标、机器人偏移设置等三样参数设定。动作页面(Motiom Page)此参数当执行时,代表要求机器人执行所指定的动作页面,当在判断时表示检查现在正处于哪一个动作页面。下面介绍主要功能及限制 输入某个数字后,则执行该数字所指定的页面。 可以检查正处于哪个页面。 可以利用Motion的ExitPage来停止动作。 如果确认是否停止动作可以检查动作旗标。 当动作页面设置为0控制执行Exit Page的页面并停止。 当动作页面设置为-1控制器将执行到最后输入的页面并停止。
21、动作页使用数字1225之间。动作旗标(Motion Status)是为了显示现在是否执行Motion动作,如果正在执行数值将会是1,未执行则是0。机器人偏移设置(Joint Offset)是一个陀螺仪姿势调整。 图1.8 RoboPlus Motion工作界面RoboPlus Manager是机器人控制管理员。可以对Dynamiexl进行设定,如更改ID、更改动作模式、修改ZigBee对应编号等。 图1.9 RoboPlus Manager工作界面1.3本文章节安排 本文以舵机机器人系统为平台,研究在基于声音传感器基础上,编写控制程序,让机器人运行特定的动作。实验采用Bioloid机器人套件为
22、实验机器人,运行环境在室内,机器人上将配备红外线物体传感器、声音传感器(集成于控制器CM-530)。在特定运动环节,文章将分别利用红外线物体传感器和声音传感器得到外界信息,然后将信息传递到控制器CM-530,进而控制器发出指令使舵机机器人做出特定的动作。本文的主要组织结构安排如下:第1章是绪论,简述了基于声音控制舵机机器人的发展现状和研究意义,对Bioloid机器人套件的软件和硬件进行了简要的介绍。 第2章介绍舵机机人控制硬件系统,并提出已此系统作为基于声音的舵机机器人运动控制平台。 第3章介绍舵机的内部结构、工作原理以及控制方法。 第4章介绍现阶段可用的控制方法,说明选用PID算法的理由,将
23、PID算法运用到本实验中,证明PID算法在本实验中的可行性。第5章用行为控制和动作编辑两种编程相结合的方法来编写舵机机器人控制程序,并说明了两种编写程序所负责编写的内容。第6章对本论文中的内容做了总结和回顾,并对实验的不足方面提出改进。对舵机机器人的未来发展方向进行展望。2 舵机机人控制系统硬件设计2.1电子元器件选择在对舵机机器人系统建立之前,首先应对电子元器件进行选择。是否能选择合适的电子元件将会直接影响到所设计的控制系统的性能。2.1.1控制器的选择嵌入式系统中的微处理器和微控制器从二十世纪七十年代研发至今已经拥有40年的发展历史了。嵌入式系统最开始的的应用只能是基于单片机,而且那时只是
24、4位的处理器在被使用,应用在一些单线程的程序上,还说不上“系统”这一概念。但是嵌入式系统基于单片机的使用,却使得家用电器、汽车电子、工业机械设备、通信设备以及成百上千种产品可以通过嵌入式电子系统获得更好的实用性能。当今,嵌入式控制系统中微控制器应用范围最广的是单片机,而 MCS-51和 96 系列是单片机中的代表。但由意法半导体公司推出的STM32微电子芯片具有单片机所没有的优点,它具有高性能的内核、一流的外设、低功耗以及最大的集成度等特点。4。除此之外STM32系列采用了业界领先的哈佛结构(程序和数据分开),提供单周期乘法指令和硬件除法指令,内置了快速的中断器等。正是由于STM32使用了这些
25、与MCS-51普通单片机不同的结构,才使得其与普通单片机相比具有如下特点5:1) 完成一次乘法或一次加法在一个指令周期内就可以实现;2) 采用哈佛结构,程序总线和数据总线、程序空间和数据空间是分开的,这一结构使其可以同时访问指令和数据;3) 片内拥有快速 RAM,可以同时访问两块芯片中RMA;4) 具有低开销或无开销循环及跳转的硬件支持;5) 快速的中断处理和硬件 I/O 接口支持;6) 具有在单周期内操作的多个硬件地址产生器;7) 内部采用的特殊设计使其支持并执行多个操作任务;8) 支持流水线操作,使取指、译码和执行等操作可以重叠执行。考虑到这种芯片的高性价比以及舵机机器人控制性能的要求,选
26、用有STM32F103芯片的CM-530控制器作为舵机机器人的微控制器。这样不仅可以大大的提升控制机器人的性能,还可以减少控制器的大小。 图2.1 CM-530控制器 PC Link(Serial Cable): 用来连接CM-530和PC。也可以用来与其他PC连接和下载任务程序。Communication Device Connection Port:无线模块(ZIG-110),与红外线接收器或其他模块连接使用。Battery Jack:电池插座。Power Jack:电源插座。Mode LED:显示操作模式之LED。Status LED:显示状态之LED。Power LED:显示电源开关状
27、态之LED。Power Switch:电源开关MODE Button:模式切换按钮。START Button:执行所选择的模式。U/L/D/R Button:程序运行时,发送指令给机器人使用。AX-12+ BUS Port:AX12+ Dynamixel串接插座。Peripheral Devices Connection Port:l连接距离传感器、触碰传感器、红外线传感器以及周边设备。2.1.2舵机的选择传统的舵机有三条传输线,分别是:VDD线、GND及DATA线。VDD和GND线是提供内部的直流马达及控制线路板所需的电源,电压通常介于7V-10V之间,该电源应尽可能与处理系统的电源分隔开,
28、因为马达会产生噪音。同时,舵机在重负载时也会拉低放大器的电压,所以整个系统的电源供应必须合理6。在这里本文选用AX-12+舵机,是由于Dynamixe系列中AX-12+专用于机器人伺服电机与传统的伺服电机相比不但具有位置反馈,而且还具有速度反馈与温度反馈的功能,支持高速串行网络.这样选择AX-12+就可以更好的完成机器人的驱动任务。 图2.2 AX-12+硬件电路原理图 2.1.3其他元件的选择在设计整个控制系统中,使用的控制其中搭配了声音传感器,可以判断声音的大小。声音传感器使用数字0至255之间,因此最高音量为225。除声音传感器外还有声音计数器,声音的计数方法,判断法则为高于所设定的参数
29、数据则判断为一次的声响,而感应为声音传感器,当感测出来时声音计数器会+1。此外,本实验还会用到红外线物体感测器。2.2舵机机器人控制系统设计如图2.3所示 舵机机器人的控制系统的设计应包括电源模块、微控制器模块、舵机驱动模块、红外线物体传感器模块及声音传感器模块等传感器模块组成。 图2.3舵机机器人控制系统在整个系统中由电源模块提供12伏电压供电给控制器CM-530,又通过声音传感器和红外线传感器接收外界信息,接收信息后将信息传给控制器,然后控制器按照PC已经编写好的程序发出指令,舵机做出设定好的动作。2.3舵机机器人组装本论文应用到Bioloid机器人套件,将机器人套件组装成四足机械狗。整个
30、机器人用到15个AX-12+舵机,一个CM-530控制器,一个红外线物体传感器以及若干框架组。组装实物如下图: 图2.4四足机械狗四足机械狗所涉及15个舵机的控制中全部用于关节,转动角度为0300。 表2-1是四足机械狗的舵机分配表。机器人关节 电机ID头部舵机17劲部舵机16左前腿舵机5舵机7舵机9右前腿舵机4舵机6舵机8左后腿舵机11舵机13舵机15右后腿舵机10舵机12舵机14尾部舵机1 2-1四足机械狗的舵机分配表2.4本章小结本章介绍了舵机机器人硬件的选择,也对基于声音的舵机机器人的控制系统做了硬件设计。给出了所要用的实验器材,尤其是微控制器的选择。分析了各个模块与整个系统的关系,将
31、各个模块整合成一个整体。最后介绍了舵机机器人的组装过程。 3 舵机的结构及其控制原理本文章中所选用的AX-12+数字伺服电机具有高效能、串接式、连接简单、全方式360定位等特点。采用PID控制,适合多关节系统的应用(如机械手臂,六足、双足机器人)。3.1舵机的内部结构舵机是由外壳、电路板、直流电机、齿轮组与位置检测器组成的。如图3.1所示。高速转动的直流电机提供了所需的动力,带动变速(减速)齿轮组转动,使之产生高力矩的输出齿轮组的变速比愈大,伺服马达的输出力矩也愈大,越能承受更大的力量,但是齿轮的转动的速度也会变得很低。 图3.1 舵机的内部结构3.2舵机的工作原理舵机是一个典型的闭环反馈系统
32、,其工作原理如下图: 图3.2舵机的工作原理减速齿轮组依靠马达驱动,其终端(输出端)带动一个线性的比例电位器作位置检测,该电位器把转角坐标转换为一比例电压反馈给控制线路板,控制线路板将其与输入的控制脉冲信号做比较,产生调整脉冲,并驱动马达正向或反向地转动,使齿轮组的输出位置与期望值相一致,令调整脉冲趋于零,从而达到使舵机精确工作的目的7。3.3 AX-12+舵机的控制AX-12+数字伺服电机不像一般的R/C微伺服电机(舵机)使用PWM(脉冲宽度调制)控制,其需要使用CM-5DynamixelAX12+伺服电机专用控制器控制。当用做关节电机时,可以旋转0300;当用作轮子驱动时,可以选择360连
33、续旋转模式。更重要的是AX-12+提供了高达16kgcm的扭矩,是一般数字舵机的2倍8。 图3.3 AX-12+与CM-5伺服电机专用控制器控制器接法 3.4本章小结 本章介绍了舵机的内部结构,工作原理即控制方法(PWM传统舵机的控制方法)。还说明了AX-12+舵机与传统舵机控制方法的不同点,其具有一般舵机所没有的优点。4 舵机机器人的速度控制4.1引言舵机机器人控制有2种方法分别是开环控制和闭环控制,在开环控制中,机器人的运动速度并没有进行反馈,从而无法确保机器人按照预期的速度前进或后退。但在闭环控制方法中,通过电位器检测机器人舵机的转速,进而可以实时获得机器人的运动速度,并通过闭环控制算法
34、控制机器人使其按预定速度进行运动,常用的闭环控制算法有:自适应控制、模糊控、神经网络控制和PID控制等,其中PID控制是由比例(Proportion)、积分(Integral)、微分(Differential)组成的线性控制器,原理简单,应用方便,适合用于比较简单的被控对象,应用该控制算法能够获得很好的控制效果,并且构成的控制系统具有良好的控制性9。PID控制理论问世至今己有近70年历史,它以其技术成熟、应用范围广、稳定性好、调整方便、控制灵活而成为工业控制理论的主要技术之一。本章将采用PID控制算法进行舵机机器人的速度闭环控制10。4.2数字PID控制算法11PID是一个闭环的控制算法。因此
35、在实现PID算法之前,硬件上必须采用闭环控制,就是有反馈。PID是比例(P)、积分(I)、微分(D)控制算法。但并不是必须同时具备这三种算法,也可所以PD,PI,甚至是P算法控制。下面就对PID算法的原理做简单介绍: 模拟PID算法的原理如图4.1所示,其中,w(t)是设定值,y(t)是系统实际输出值,而e(t)是w(t)与y(t)的偏差值即: (4.1)按其比例、积分、微分通过线性组合构成控制量。其表示如下图: 图4.1PID控制原理u(t)是PID控制器的输出和被控对象的输入,模拟PID控制器规律为: (4.2)其中KP为比例增益,TI为积分时间常数,TD为微分时间常数,u(t)为控制量,
36、e(t)为偏差。PID算法中各环节的作用:比例控制可以快速反应误差,从而使误差减小,但是比例控制却不能消除稳态误差,而且如果KP过大,就会引起系统不稳定;积分控制的作用是,只要系统存在误差,积分控制作用就会不断积累并输出控制量从而消除系统误差,因此只要时间允许,理论上积分控制将能完全消除误差,但是积分作用过强会使系统超调量有所增大,甚至会使系统产生振荡;微分控制作用是可以减小超调量,克服振荡,从而使系统的稳定性得到提高,与此同时加快系统的动作的响应速度,减小调整时间,从而改善系统的动态性能。由于论文是采用数字PID控制舵机速度,因此应用数字PID增量型控制型算法。其求解过程如下:为了便于计算机
37、的实现,必须把式(4-2)变换成差分方程,为此做如下近似 (4.3) (4.4)由式(4-2)、(4-3)、(4-4)可得数字PID位置控制算式为 (4.5)根据式(4-5)不难写出第k-1次采样时的控制算式 (4.6)将式(4-5)和(4-6)相减即得到数字PID增量型控制算式为 (4.7)其中KP称为比例增益,KI=KP称为积分系数, KD= KP称为微分系数。为了方便,可以将(4-7)整理成如下形式u(k)=q0e(k)+q1(k-1)+q2e(k-2) (4.8)其中q0=KP(1+) q1= - KP(1+2) q2= KP (4.9) 从(4-9)可以看出,若整个控制系统确定采样周
38、期T,选用合理KP、TD、和TI就可以确定增量。4.3基于数字PID的机器人速度控制本节将以CM-530控制器,采用数字PID控制算法,通过对舵机AX-12+的转速控制来实现舵机机器人的速度控制。 在数字PID控制算法中,若确定采样周期T,剩余最重要的工作就是确定KP、TD、和TI三个参数,因为有上一节已经了解了PID算法中各环节的作用就可以明白,这三个参数选择将会直接影响控制效果的好坏。参数整定的实质就是利用改变PID控制器参数使其特性和过程特性达到相互匹配,进而改善系统的静态和动态指标,达到最好的控制效果。整定控制器参数的计算方法归纳起来有工程整定法与理论计算整定法两类,工程整定法有临界比
39、例法。试凑法、衰减曲线法、响应曲线法等,该方法的特点是在计算前并不需要知道该过程的数学模型,直接在过程控制系统中进行现场整定,该整定方法方便简单、容易掌握;计算简单理论计算整定法有根轨迹法和对一数频率特性法等12。本文的整个PID控制过程的流程图如图4.2所示 图4.2舵机的程序控制图 本文中由AX-12+舵机的技术手册得到通讯波特率7343bps1Mbps,采用的通讯协议是半双工异步串行通讯,采用试凑法整定KP、TD、和TI三个参数的值。数对控制效果的影响趋势,反复调整KP、TD、和TI大小,一般是按照先比例,再积分,最后微分的步骤整定参数。4.3.1PID控制的MATLAB仿真MATLAB
40、是由美国MathWorks公司出品的商业数值计算和可视化软件,它的功能包括数据分析、数据可视化、矩阵运算、信号处理和图形显示等。MATLAB在数学类科技应用软件中在数值计算方面是首屈一指的,它不仅为用户构成了一个方便的、界面友好的环境,而且具有十分丰富的函数库。MATLAB和其他高级语言一样具有良好的接口,同时也可以方便地实现与其他语言程序的混合编写,使它已经成为当今最为流行的科学与工程计算的软件工具之一,从而受到了广大用户的热烈欢迎13,14。本论文中,采用的舵机是AX-12+该电机的参数为:额定电压,转速15300r/min,电动势常数Ce0.0173V/(r/min),电机时间常数T 0
41、.12S电磁时间常数i 0.02。直流电机的传递函数模型为15: (4.10)将电机参数代入式(4-10),得到舵机的数学模型为: (4.11)PID应用Matlab参数整定过程如下16-20:(1)起初,只保留比例系数Kp而将积分系数Ti和微分系数Td置为0。其Matlab的系统控制仿真图如4.3所示 图4.3不同Kp下Matlab仿真图由仿真结果可知:比例项确实可以减小控制系统产生的偏差,伴随着Kp的增加,整个系统的响应速度也越来越快。但Kp过大,则系统会产生超调,震荡次数也会有所增多,增加了调节时间,使系统稳定性也会有所下降。 因此Kp的增大不可能从根本上消除稳态误差,只能减小。上图Kp
42、值分别是5,10,15比例控制Kp Matlab程序如下: G=tf(400,1 50 417); Kp=5:5:15; for i=1:length(Kp)Gc=feedback(Kp(i)*G,1);step(Gc),hold onend(2)设Kp=10,讨论Ti=0.050.15时PID的控制情况,进行Matlab的仿真图如下: 图4.4不同Ti下Matlab仿真图对于积分系数 Ti的主要作用是消除控制系统的稳态误差,增强系统的无差度。但随着Ti的逐渐增大,超调量会有所减小,系统的响应速度会变的很慢,有时甚至会有积分饱和的现象产生。上图Ti值分别为0.05,0.10,0.15。积分控制
43、Ti Matlab程序如下: G=tf(400,1 50 417);Kp=10;Ti=0.05:0.05:0.15; for i=1:length(Ti)Gc=tf(Kp*Ti(i) 1,Ti(i) 0);Gcc=feedback(Gc*G,1);step(Gcc),hold onend(3) 微分系数Td的大小反映的是偏差的变化率,起着预见的作用,从而改善了系统的动态性能。微分实验理论原理与比例、积分一样。如果Td过大,系统就会提前制动,使调节时间变长,于此同时也会使控制系统的抗干扰能力有所下降。G=tf(400,1 50 417);Kp=10;Ti=0.1Td=0.005:0.005:0.
44、015; for i=1:length(Td)Gc=tf(Kp*Ti*Td(i) Ti 1,Ti 0);Gcc=feedback(Gc*G,1);step(Gcc),hold onend经过这样不停的反复实验最终可以确定PID的各个参数Kp=10,Ti=0.1,Td=0.01。从而达到应用PID控制法来控制舵机速度。4.4本章小结本章介绍了PID控制算法及其控制原理,将PID算法和AX-12+舵机的控制结合起来,说明了PID控制算法的优越性和应用的广泛性。5 舵机机人控制系统软件设计舵机机器人控制系统中软件设计是最重要的部分,所有舵机运行状况都是有控制系统软件设计的。本文的控制系统是基于STM
45、32F103为主要元件的硬件之上进行设计的,因此在实验时直接使用了基于STM32F103开发的CM-530控制器。本控制系统软件设计主要包括;程序编写、调试、修改、整合等步骤。5.1 RoboPlus Task程序的编写RoboPlus Task的程序命令语法和一般的C语言语法非常相似(称为类C语言),另外还有额外独立开发的外部无穷循环函数(CallBack函数),可以双向多工运作,虽然第二工作函数中有许多的判断语言无法使用,且不能和主程序做太多关联(会发生错误),但实质的应用层面却比传统的C语言的架构程序来的好上很多。下面介绍命令句:Start&End :启动&结束命令句Start/Exit
46、 Program :开始和结束的命令“&”:区块命令,主要在定义范围/ :注解,主要是使用者加以说明程序用,不会执行Execute :执行/运算命令句Compute :运算命令句,包含数字运算、逻辑运算等Load :加载命令句,左侧的数值将会等于右侧数值Label :标签,主要是用来跳跃之用Jump :跳跃,能够跳跃至指定的标签位置Condition :判断命令句If/Else If/Else :用于判断内容的命令Loap :循环命令句Endless Loap:无限回圈Condition Loop :条件循环,条件达成则执行循环Count Loop :次数循环,可以指定次数的循环Break L
47、oop :跳出循环,强制离开回圈之前的命令句Conditional Stand :等待循环,条件满足时将锁定在这个循环中,直到条件解除Function :子程序/函数命令句Make CallBack :创造独立的无穷循环Make Function :创造一个子程序Call Function :呼叫子程序Exit Function :离开子程序(只要是子程序都必须使用)、在任何的程式一般都要事先设计流程图,不能凭空想象,所以必须制作一个流程图来设计所需的程式走向绘制流程图的最大好处在于循序渐进的方式来达到所需的功能,能避免将许多重复性的元件、架构再次撰写、浪费记忆空间进而增加了程式读取执行效率,
48、图5.1给出了程序的动作流程图。在程序开始之前,必须进行设定初始化。由于本控制系统用到了15个舵机,所以在初始化阶段就要包括对电机ID、电机转速以及电机的转动角度的初始化。舵机ID初始化就是读取读取舵机的ID设计,确定ID号。 图5.1程序动作流程图(1) 图5.2程序动作流程图(2) 图5.3程序动作流程图(3)在整个程序动作流程图中,由RoboPlus Task建立起整个程序架构。由于所组装的舵机机器人用到了15个电机,数量较多,因此仅仅依靠RoboPlus Task来编程控制15个电机是不便的。所以用RoboPlus Motion来编写具体的动作即上述框架中的动作1到动作11。在确定程序
49、的框架图后,就可以根据框架图来编写设计程序,具体程序代码在附录。5.2RoboPlus Motion程序的编写 本论文中所设计的舵机机器人的动作共有11个,具体动作编辑在附录。其具体的编辑过程如下: 如图5.2机器人的动作设计可以借由右下角的两个灯泡(一个亮,一个灭)来控制机器人马达的启动和不启动。在不启动状态下,可以搬动机器人马达关节,来设计自己所需的动作。然后将所设计的动作的关节值传送给控制器,控制器将动作关节值保存在所设计动作页面。 图5.2 舵机机器人动作编辑界面 在动作设计上必须要参考流程图的设计,也就是说不能把所有动作串连在一起,所以在动作编辑器上使用相同的方法简化程序。简化的这部
50、分程序可以省略掉大部分连续马达动作,如果但使用行为控制逻辑控制全部马达是非常费时的,因此可以使用行为控制逻辑控制动作编辑器元件代替掉许多马达的控制,从而简化程序的编写。5.3本章小结本章介绍了舵机机器人的软件设计过程,由RoboPlus Task建立编写程序的框架,主要包括机器人动作的先后顺序、各传感器的控制程序、舵机的初始设计等。使用RoboPlus Motion来设计具体动作。6 总结与展望 6.1总结基于声音控制的舵机机器人是多技术相结合的一个融合体。随着机器人技术的不断发展,对对舵机机器人的理论研究也越来越深入。本文以Bioloid机器人套件为实验平台,以舵机机器人的声音控制系统的结构
51、为主线,编写了基于声音的舵机机器人的控制程序,在此基础上对舵机机器人的运动做出了分析。论文研究的主要内容如下:(1)以舵机机器人为背景,设计了基于CM-530微控制器的舵机机器人的运动控制系统。它以STM320芯片为核心,运用PID控制控制算法和DynamixelAX12+伺服电机专用控制器控制CM-530,完成了舵机的控制。将舵机硬件设计和软件编写结合起来,实现了舵机机器人特定动作的运行,并通过声音传感器和红外线物体传感器将外界反馈信号传给控制器,使舵机机器人根据外界情况作出动作。(2)应用了舵机机器人的动作平台,可以对任意的舵机机器人进行动作设计,通过串口通信可以实时控制舵机机器人的动作,并能将舵机机器人动作产生的数据传送回电脑,以便对机器人的动作做出分析。(3)对常用的控制算法作了简单介绍,重点说明了AX-12+舵机所应用的PID控制算法。详细地论述了该算法的实现在舵机机器人运动中的应用。6.2展望 本文所介绍的工作主要是通过声音传感器对舵机机器人的控制,使其做出特定的动作。基本上完成了任务书中的要求,但仍由去多地方需进一步改进和研究:(1)本论文试验中所应用的CM-530控制器是基于STM320芯片设计的,虽然可以较好地控制舵机机器人的运动,但仍有很大的发展空间。从提高舵机的控制速度与效果出发,我们可以应用更为高级的芯片,当然这样成本也会有所增加,但
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
最新文档
- 2026年手足显微专科模拟试题及参考答案
- 海关健康提醒-标准模板
- AI投资基金-标准模板
- 2026高中教资面试生物答辩真题题库参考答案
- 高中教资面试英语答辩历年真题高频考题参考答案
- 户外展销会人员失踪现场寻人活动主办方预案
- 2025-2026学年吉林白城实验高级中学高一上10月月考历史试卷含答案
- 大学物理量子力学波函数概念训练试题及答案
- 高中语文古诗表达山水诗自然景象描写分析训练试题及答案
- 高中物理实验电路测量电感性质实验分析测试试卷及答案
- 2026北京市朝阳区卫生健康委员会所属事业单位第二批招聘241人笔试备考题库及答案解析
- 4.1妈妈教学设计
- 2026年内蒙古中考语文试卷及答案
- 成人术中外周静脉输液技术操作及管理指南
- 八年级物理第二学期期中考试质量分析
- 2026-2030中国化机浆市场竞争规划与未来前景发展趋势研究报告
- 2026粉末冶金开发高速钢刀片脱模剂适用性分析报告
- 三角函数压轴题专项训练-2026年高考数学 含答案
- 退役军人创新创业大赛
- 心脏MRI在急性心肌梗死诊断中的临床价值与应用
- 2026年辽宁省公安厅招聘警务辅助人员笔试试题(含答案)
评论
0/150
提交评论