《模糊PID的全方位挪动机器人运动控制设计_1.docx》由会员分享，可在线阅读，更多相关《模糊PID的全方位挪动机器人运动控制设计_1.docx（9页珍藏版）》请在taowenge.com淘文阁网|工程机械CAD图纸|机械工程制图|CAD装配图下载|SolidWorks_CaTia_CAD_UG_PROE_设计图分享下载上搜索。
1、模糊PID的全方位挪动机器人运动控制设计邢媛导语：通过对足球机器人运动学模型的分析，考虑到系统的时变、非线性和干扰大等特点，以全向挪动机器人为研究平台，提出一种将模糊控制与传统的PID控制相结合的方法0前言模糊控制技术，已经成为智能控制技术的一个重要分支，它是一种高级算法策略和新奇的技术。自从1974年英国的马丹尼(E.H.Mandani)工程师首先根据模糊集公道论组成的模糊控制器用于蒸汽发动机的控制以后，在其开展历程的30多年中，模糊控制技术得到了广泛而快速的开展。如今，模糊控制已广泛地应用于冶金与化工经过控制、工业自动化、家用电器智能化、仪器仪表自动化、计算机及电子技术应用等领域。尤其在交
2、通路口控制、机器人、机械手控制、航天飞行控制、汽车控制、电梯控制、核反响堆及家用电器控制等方面，表现其很强的应用价值。并且目前已有了专用的模糊芯片和模糊计算机的产品，可供选用。我国对模糊控制器开场研究是在1979年，并且已经在模糊控制器的定义、性能、算法、鲁棒性、电路实现方法、稳定性、规那么自调整等方面获得了大量的成果。著名科学家钱学森指出，模糊数学理论及其应用，关系到我国二十一世纪的国力和命运。近几年来，随着机器人技术与控制技术的开展，机器人在日常生活和工农业消费中得到广泛应用。机器人对象是一个非线性、强耦合的多变量系统，在运动经过中由于存在摩擦、负载变化等不确定因素，因此它还是一个时变系统
3、。传统的机器人控制技术大多是基于模型的控制方法，无法得到满足的轨迹跟踪效果模糊控制和神经网络等人工智能的开展为解决机器人轨迹跟踪问题提供了新的思路。普通模糊控制的控制规那么大局部是人们的经历总结。不具备自学习、自适应的才能，往往还受到人的主观性的影响。因此不能很好地控制时变不确定的系统。挪动机器人是一个集环境感悟、动态决策、行为控制与执行等多种功能于一体的综合系统，其运动控制是挪动机器人领域的一个重要研究方向，也是挪动机器人轨迹控制、定位和导航的根底。传统的运动控制常采用PID控制算法，其特点是算法简单、鲁棒性强、可靠性高，但需要准确的数学模型才对线性系统具有较好的控制效果，对非线性系统的控制
4、效果并不理想。模糊控制不要求控制对象的准确数学模型，因此灵敏、适应性强。可是，任何一种纯模糊控制器本质上是一种非线性PD控制，不具备积分作用，所以很难在模糊控制系统中消除稳态误差。针对这个问题，结合运动控制系统的实际运行条件，设计采用模糊PID控制方法来实现快速挪动机器人车轮转速大范围误差调节，将模糊控制和PID控制结合起来构成参数模糊自整定PID算法用于伺服电机的控制，使控制器既具有模糊控制灵敏而适应性强的优点，又具有PID控制精度高的特点，使运动控制系统兼顾实时性高、鲁棒性强及稳定性等设计要点，并可通过模糊控制规那么库的扩大，为该运动控制系统方便添加其他功能。1全方位挪动机器人运动学分析研
5、究的是一种全自主挪动机器人平台，该机器人采用了四轮全向挪动的运动方式，具有全向运动才能的系统使机器人可以向任意方向做直线运动，而之前不需要做旋转运动，并且这种轮系可知足一边做直线运动一边旋转的要求，到达终状态所需的任意姿态角。全向轮系的应用将使足球机器人具有运动快速灵敏，控球稳定，进攻性强，以及易于控制等优点，使机器人在赛场上更具竞争力。1.1全向轮机器人采用的全向轮在大轮的四周均匀分布着小轮，大轮由电机驱动，小轮可自由转动。这种全方位轮可有效防止普通轮不能侧滑所带来的非完好性约束，使机器人具有平面运动的全部3个自由度，机动性增强。基于以上分析，选择使用这种全向轮。1.2运动学分析在建立机器人
6、的运动模型前，先做以下假设：1小车在一个理想的平面上运动，地面的不规那么可以忽略。2小车是一个刚体，形变可以忽略。3轮子和地面之间知足纯滚动的条件，没有相对滑动。全方位挪动机器人由4个全向轮作为驱动轮，它们之间间隔90均匀分布，如图1所示。其中，xw-yw为绝对坐标系，xm-ym为固连在机器人车体上的相对坐标系，其坐标原点与机器人中心重合。为xw与xm的夹角，为轮子与ym的夹角，L为机器人中心到轮子中心的间隔，vi为第i个轮子沿驱动方向的速度。图1机器人的运动模型可求出运动学方程如式1所示：由于轮子为对称分布，常数为45，故得到全向挪动机器人的运动模型：V=Ps其中，v=v1v2v3v4T为轮
7、子的速度，s=为机器人整体期望速度，P为转换矩阵。这样，就可以将机器人整体期望速度，解算为到4个轮子分别的速度，把数据传送到控制器中，就可完成对机器人的控制。2基于模糊PID的运动控制器设计目前，常规PID控制器已被广泛的应用于自动化领域。但常规PID控制器不具备在线整定控制参数kp、ki、kd的功能，不能知足系统在不同偏向对e以及偏向值的变化率ec对PID参数的自整定要求，因此不适用于非线性系统控制。文中结合本运动控制系统的实际运行条件，设计采用模糊PID控制方法来实现快速挪动机器人车轮转速大范围误差调节，将模糊控制和PID控制结合起来构成参数模糊自整定PID算法用于伺服电机的控制，使控制器
8、既具有模糊控制灵敏而适应性强的优点，又具有PID控制精度高的特点，使运动控制系统兼顾了实时性高、鲁棒性强及稳定性等设计要点，并可通过模糊控制规那么库的扩大，为该运动控制系统方便添加其他功能。2.1参数模糊自整定PID的构造模糊PID控制系统构造如图2所示，系统的输入为控制器给定轮速，反应值为电机光电码盘反应数字量，kp、ki、kd为修正参数。图2自适应模糊控制器构造2.2速度控制输入输出变量模糊化在此速度控制器中的输入为实际转速与设定转速的偏向值e,以及偏向值的变化率ec,输出量为PID参数的修正量kp、ki、kd.它们的语言变量、根本论域、模糊子集、模糊论域及量化因子。模糊变量E和EC以及输
9、出量KP、KI、KD的语言变量和论域确定后，必须对模糊语言变量确定其隶属度。常用的隶属函数有B样条基函数、高斯隶属函数、三角隶属函数等，考虑到设计简便及实时性的要求，本文中采用三角隶属函数。2.3参数自整定规那么模糊控制设计的核心是总结工程设计人员的技术知识和实际操纵经历，建立适宜的模糊规那么表，得到针对kp,ki,kd这3个参数分别整定的模糊控制表。根据kp,ki,kd这3个参数分别的作用，可制定模糊控制规那么，以kp为例，列规那么如表2,ki,kd可类似推出。PID参数的模糊自整定是找出PID三个参数Kp、Ki、Kd与e和ec之间的模糊关系，在运行中通过不断的监测e和eczaoche168
10、，根据模糊控制原理对三个参数进展在线的整定。PID参数的设定是靠经历及工艺的熟悉,参考测量值与设定值曲线,进而调整Kp、Ki和Kd的大小。模糊控制规那么是用于修正PID参数的，模糊控制规那么根据经过的阶跃响应情况来考虑求取。规那么如下所示：1预选择一个足够短的采样周期让系统工作;2仅参加比例控制环节,直到系统对输入的阶跃响应出现临界振荡,记下这时的比例放大系数和临界振荡周期3根据下面的详细规那么修改PID控制器参数，直至满足为止。根据上面所述的模糊控制规那么，采用如下的PID参数的调节规那么，如表1、表2、表3所示。表1Kp规那么调节表表2KI规那么调节表表3KD规那么调节表2.4输出量解模糊
11、根据速度模糊控制参数整定规那么确定出输出量后，得到的只是一个模糊集合，在实际应用中，必须用一个准确量控制被控对象，在模糊集合中，取一个最能代表这个模糊集合的单值经过称为解模糊裁决。常用的解模糊算法有最大隶属度法、加权平均法等，根据实际情况，采用加权平均法进展解模糊。模糊PID控制程序流程如图3所示。图3模糊PID控制程序流程图3实验结果为验证参数模糊自整定PID控制器的有效性，文中对直流电机分别做了常规PID控制和模糊PID控制实验。实验中给定轮速为50r/min。相比常规PID控制算法，采用参数模糊自整定PID算法可以明显降低超调量，加快响应速度，改善控制系统对轮速的控制效果。4结论机器人运动控制系统是整个Robocup机器人系统的执行机构，在场上的表现直接影响了整个足球机器人系统。文中以足球机器人为平台，考虑到系统的时滞性和非线性，采用模糊控制与PID控制相结合的方式，并在自行研制的足球机器人上进展了速度控制的实验研究。结果说明，该方法弥补了常规PID控制应用在机器人运动速度控制时超调量大，响应时间长的缺点，可以获得理想的效果。