基于模糊预测控制的救援AGV轨迹跟踪研究.pdf
《基于模糊预测控制的救援AGV轨迹跟踪研究.pdf》由会员分享,可在线阅读,更多相关《基于模糊预测控制的救援AGV轨迹跟踪研究.pdf(7页珍藏版)》请在咨信网上搜索。
1、474第4 0 卷第6 期2023年6 月真机仿算文章编号:10 0 6-9 34 8(2 0 2 3)0 6-0 4 7 4-0 6基于模糊预测控制的救援AGV轨迹跟踪研究舒静青,时伟,汪宇阳(中南大学航空航天学院,湖南长沙4 10 0 8 3)摘要:针对救援自动导引车(AGV)的轨迹跟踪算法问题,设计了ACV小车的轨迹跟踪控制器,采用模糊控制与模型预测控制算法结合,以模型预测控制算法弥补模糊算法中控制精度不高、动态品质差等缺陷。对纯模糊控制和模糊-预测控制开展simulink仿真进行对比研究,结果表明,与纯模糊控制相比,模糊-预测控制能在存在初始误差条件下对任意合理的设定轨迹进行跟踪,且在
2、过程中能快速有效消除位置误差和角度误差,提升轨迹跟踪的控制精度;同时减少误差收敛时间,提高动态跟踪效率,验证了模糊-预测算法具有更优的控制性能。关键词:模糊控制;模型预测控制;轨迹跟踪;模糊预测控制中图分类号:TP391.9文献标识码:BTrajectory Tracking of Rescue AGV Based onFuzzy-Model Predictive ControlSHU Jing-qing,SHI Wei,WANG Yu-yang(School of Aeronautics and Astronautics,Central South University,Changsha H
3、unan 410083,China)ABSTRACT:Aiming at the trajectory tracking algorithm problem of rescue AGV,we designed a trajectory trackingcontroller for AGV.The fuzzy control was combined with model predictive control algorithm,and the model predictivecontrol algorithm was used to improve the defects of the fuz
4、zy algorithm,such as control precision and dynamicquality.To verify the trajectory tracking capabilities,the fuzzy controller was compared with a fuzzy-model predictivecontroller under the simulation experiment.simulation results show that fuzzy-model predictive control can effectivelyimprove the co
5、ntrol accuracy and speed of trajectory tracking.KEYWORDS:Fuzzy control;Model predictive control;Trajectory tracking;Fuzzy-model predictive control1引言近年来,地震等自然灾害给人类的生命和财产带来极大的损失,灾后快速响应和救援工作的及时开展对保障人民生命财产安全至关重要。救援自动导引车(AutomatedGuidedVehicle,ACGV)是一种灾后废墟救援机器人,能够在复杂、危险的救援任务中能够承担物资运输和转移、人员搜寻和营救等重要工作2 震后
6、环境复杂,救援ACV小车在救援现场环境中按规划路径行驶时,可能受到未知外界因素干扰,使之偏离指定路径,对于救援AGV小车轨迹跟踪的研究,能让小车在行驶中对沿规划路径运动时产生的偏差进行纠正,从而实现对给基金项目:国家自然科学基金资助项目(6 2 0 0 336 9);湖南省自然科学基金资助项目(2 0 2 1JJ40784)收稿日期:2 0 2 1-11-0 1修回日期:2 0 2 1-11-0 6定路线的逼近3,是AGV小车自主移动的关键环节。由于车辆系统具有非完整约束条件,是强非线性、高度耦合的复杂系统,很难建立精确的车辆动力学系统模型4,无人驾驶车辆的轨迹跟踪控制始终是一个难点。目前传统
7、的控制方法在面对多参数的非线性系统被控对象时,已经表现出劣势,需要用其它智能控制算法进行优化,如模糊控制、模型预测算法等无需建立精确模型的控制算法。模糊控制算法适用于大部分非线性模型5与其它控制算法结合,能有效解决控制中的非线性、强耦合等问题,提高控制系统的鲁棒性。Wang等人6 将模糊控制用于PI控制器的参数自整定,以控制机器人的伺服电机,发现模糊控制的加人能有效提升轨迹的跟踪效果。M.Septyan等人7 提出了一种非线性动力学的模糊控制器,旨在解决跟踪具有初始误差的非光滑轨迹误差问题,仿真结果表明该控制器能够精确跟踪非光滑参考轨迹,且能有效消除初始位置误差引起的大姿态变化。Z.Sun8将
8、模糊控制与滑膜控制相结合,设475计了基于麦克纳姆轮AGV车辆模型的联合控制器,其控制性能比传统滑模控制器跟踪精度更高,平滑度和稳定度更优。模型预测算法9 能预测未来一段时域内系统的输出量,通过解决有约束的最优控制问题,不断逼近参考值。Wang等人【10 基于简化的车辆非线性模型,将MPC控制器用于车辆的横向控制,通过引人松弛变量来软化输出约束,避免了最优解计算的不可行性,并提出了一种在预测视域内获取局部参考轨迹的新方法,大幅提升了对车辆不同速度时轨迹跟踪的性能。Liu等人将PI控制算法与MPC结合,推导出基于非线性模型预测控制比例积分自整定策略,利用预测控制的思想克服了AGV系统的复杂性和其
9、它不确定的干扰,实现AGV对于给定轨迹的执行。Chen等人【12 基于横向纵向控制,将模型预测算法与PID联合,对自动驾驶车辆进行轨迹跟踪。在横向控制中基于模型预测算法,采用8 自由度预测模型,生成最优车轮转向角,同时采用PID控制器对纵向控制以驱动或制动车辆。仿真表明模型预测与PID联合控制能得到精确的跟踪路径和准确的速度控制。本文针对救援AGV小车的轨迹跟踪算法进行了优化设计,将模糊控制与模型预测控制结合,以模糊控制为核心,用模型预测控制中的反馈矫正和滚动优化机理弥补模糊算法中控制精度不高、动态品质差等问题,以达到对设定参考轨迹的无误跟踪。基于AGV运动学模型设计控制器,将单纯的模糊控制器
10、和模糊-预测控制两种控制器情况进行仿真对比研究。2AGV运动学模型震后环境以废墟为主,是极不稳固的建筑结构;救援任务的多样性要求救援ACV有一定的负载能力,因此本文以平稳性更优,负载能力更强的四轮差速AGV小车为研究对象。图1为ACV小车的简化模型示意图,其中,前轮为万向轮,用以方向控制,后轮为驱动轮,用以提供车辆前进的驱动力。图2 为ACV运动学模型,ACV的位姿可表示为P=x,y,T,则期望位姿表示为P,=x,y,e,位姿误差为P。=x。Y。,.;小车的线速度和角速度为和w。减速器直流发电机减速器驱动轮万向轮图1四轮差速AGV小车根据图2,小车的运动学方程13为XX图2 AGV运动学模型(
11、M为轴中点,为导航角)COS0sin0(1)01A期望轨迹设定为q,=x,y,,o,T,运动控制量设定为u,AGV小车模型满足非完整移动机器人非完整约束条件14,即x,sin 0,-y,cos 0,=0(2)小车的误差方程为cos 6sin 07x,一xP。=ye-sin cos 0y,-y(3)001JLo,-对其误差方程求导可得位姿误差微分方程y.-u-u,cos.P。=ye-x,+v,sin 9.(4)一a,-Q为使AGV小车达到轨迹跟踪的目的,通过调整控制量,T,使系统误差收敛至0,即limllp。l l=0。3轨迹跟踪的控制器设计3.1模糊控制器设计3.1.1控制率由小车的位姿误差方
12、程(4)和Lyapunov稳定性条件【15设定小车的控制量为u,cos 9,+kix(5)w,+k2u,y+kgsin o.其中,ki,k2,k,为系统参数,由式(5)可知,k,控制AGV的运动速度,kz和k,联合控制AGV的角速度。要满足AGV小车轨迹跟踪目的,实现Lyapunov稳定性条件,需三个参数均大于零。ACV小车是非线性的复杂系统,使用模糊控制对控制率进行设计能够解决多个系统参数的不确定性,对参数实时进行调整,提升系统的稳定性和鲁棒性。模糊控制器原理图如图3所示,以误差e作为输人变量,误差e包含位置误差ed和角度误差ea;由模糊推理得到的控制量u为ki,k,ks三个参数。476模糊
13、控制器规则库输入输出模糊化模糊推理解模糊薄晰值精确值期望轨迹实际轨迹VAGV运动模型速度控制器W图3模糊控制原理图3.1.2模糊化规则模糊规则16 包含两个重点:1)模糊词集:将输人输出变量的状态以模糊语言描述,确定模糊子集,实际应用中通常取(负大,负中,负小,零,正小,正中,正大7 个模糊状态。2)量化因子:记论域为N=-n,-n+1,-L,0,n-1,n,通常n的取值为6,论域值为X=-a,a,则量化因子k。表达式为k。=n/a(6)设定模糊控制器的输人变量位置误差e和角度误差e。以及模糊控制器的输出变量ki,k,k,模糊语言为1SB,HB,B,M,S,HS,SS=“极大”,“很大”“大”
14、“中等”,“小”,“很小”,“极小”,论域均为-6,6。ea的论域值为0,5,e。的论域值为0,k 1的论域值为1,10,k2的论域值为1,8,k3的论域值为1,8。则对应的量化因子为:ked=12772.4,kea=;ka=0.75,ke21212eaT由于输入变量和输出变量模糊语言和论域均相同,因此模糊隶属度函数也相同,如图4。SSHSSMBHBSB0.80.60.40.206-4-20246图4模糊隶属度函数3.1.3建立模糊规则库模糊控制器的规则语句17 为:If ed=AAnd ea=BThen kl=C,If ed=AAnd ea=BThen k2=C,If ed=AAndea=B
15、Then k3=C.建立模糊规则表如下:表1k模糊控制规则表edSSHSSMBHBSBSSHBHBBMSHSSSHSHBHBBBMSHSSHBHBBBBSSeaMHBHBBBBSMBSBHBHBBBSMHBSBSBHBHBBMMSBSBSBHBHBBBB表2 k2,k3模糊控制规则表edk2k3SSHSSMBHBSBSSHBSBSBSBSBSBSBHSHBHBHBHBHBSBSBSMBBBBBBMSMMMMMMBSSMMMMMHBHSSSSSSMSBSSHSSSMHBSB3.1.4解模糊化解模糊化是将模糊集合中的模糊值转化为清晰值的过程。本文采用重心法18 解模糊化。若有n个输出值,则求取清晰
16、值的算法为k=1(7)2u.()0k=13.2模型预测控制器设计模型预测算法主要由三个部分组成:预测模型、滚动优化、反馈控制。模型预测控制器原理图如图5所示。参考轨迹u(k)实际轨迹滚动优化AGV(k)y(k)y(k+jlk)预测模型y(klk)反馈校正图5模型预测控制器原理图3.2.1预测模型被控对象ACV小车的运动学方程如式(1),是线性时变方程,而模型预测控制需在离散化模型下计算,因此先进行离散化操作19,得到离散化模型P(k+1)=Ak,P(k)+Bk,u(k)(8)477Au(t+N.U(t)u(t+1l t)u(tlt)NP-BC.ANB0000010-v,sin 0,Tcos0,
17、T0其中Ak,=01U,cos,T,Bk.,=sin 0,T0,T为控LO11tan 0,T制周期。由离散状态方程,可以预测系统未来的状态,记则得到s(k+1lt)=Ak,s(hlt)+Bk,AU(klt)(10)n(kl t)=Cr,s(kl t)推导可得预测的系统状态为其中m(t+1l t)c,A.n(t+21 t)C,A?Y(t)=n(t+N。I t)C.ANn(t+N,I t)C.ANp3.2.2滚动优化模型预测控制算法在本质上是最优化控制问题,要得到与参考轨迹差值最小的预测轨迹,可以通过优化算法来优化未来时间内系统的控制量。首先设计目标函数J(k),当目标函数最小时,预测轨迹与参考轨
18、迹之间的差值最小,AGV能够精确且快速地对轨迹进行跟踪。参考文献2 0 对目标函数的设计,设定本文的目标函数形式如下N2ln(k+ilt)-m(h+il)/g+PJ(k)=i=1N.-1ZIAU(k+ilt)/+ps2(12)其中,Q为误差权重矩阵,R为控制权重矩阵;N,为预测时域,N。为控制时域,p为权重系数,为松弛因子。控制量及控制增量的约束条件设定如下P(kI t)$(kI t)=(9)u(k-1I t)Y(t)=s(tl t)+O,AU(t)(11)0.2-0.2UminL-0.540.332J一-0.050.05AuuminL-0.0082L0.0082将式(9)带人式(11),每一
19、周期都能得到控制时域内的控制增量:Au(k),,A u(k+N。-1),将该控制增量中的第一项u(k)作用于系统,下一周期重复该过程得到新的控制增量,循环往复,逼近参考轨迹,最终实现对轨迹的跟踪。3.3模糊预测控制器设计AGV小车的模糊预测控制系统是利用模型预测控制的反复预测优化求解,以弥补模糊控制中存在的精度问题。模糊预测控制器的原理图如图6 所示。模糊控制器期望轨迹,V实际轨迹模糊控制速度控制器AGV运动模型+预测模型滚动优化反馈校正模型预测控制器图6模糊预测控制器的原理图由图6 可知,模糊预测控制分为模糊控制部分和模型预测反馈部分,输人期望位姿q,,模糊控制部分,以输出u=,,实时控制A
20、CV小车的线速度和角速度,实时调整小车的运动轨迹和角度;反馈部分加人模型预测控制,根据每一时刻的预测值,调整小车对当前时刻的控制输出量,以减小跟踪中的位姿误差。4仿真分析4.1AGV跟踪圆轨迹设定ACV以初始速度v,=1.Om/s,初始角速度w,=1.Orad/s,初始位姿p=0,0,0T,初始位姿误差p。=3,4,4.2T,跟踪圆形轨迹。分别采用模糊-预测控制和模糊控制对轨迹进行跟踪控制。54325.51三4.503.5-12.52-4期望轨迹模糊-预测轨迹5模糊控制轨迹-505X/m图7AGV跟踪圆轨迹图478模棚一预测控制3.5一模糊控制32.5u/ox21.50.50510152025
21、Time/s图:横向位置误差4.5模糊-预测控制模棚控制43.532.5三21.510.50-0.55101520253035Time/s图9纵向位置误差65模糊-预测控制模糊控制32510152025303540Time/s图10角度误差图7 为两种控制方式分别对参考圆轨迹进行跟踪,图8为横向位置误差,图9 为纵向位置误差,图10 为导航角度误差。由图7 可知,在存在初始位姿误差前提下,采用模糊-预测控制的红色轨迹线,比仅采用模糊控制的绿色轨迹线,跟踪波动幅度更小,跟踪速度更快。为清晰评价两种控制器的跟踪效果,作横向、纵向位置误差以及角度误差如图8-图10所示。由图8 可知,在初始横向偏差设
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 基于 模糊 预测 控制 救援 AGV 轨迹 跟踪 研究
1、咨信平台为文档C2C交易模式,即用户上传的文档直接被用户下载,收益归上传人(含作者)所有;本站仅是提供信息存储空间和展示预览,仅对用户上传内容的表现方式做保护处理,对上载内容不做任何修改或编辑。所展示的作品文档包括内容和图片全部来源于网络用户和作者上传投稿,我们不确定上传用户享有完全著作权,根据《信息网络传播权保护条例》,如果侵犯了您的版权、权益或隐私,请联系我们,核实后会尽快下架及时删除,并可随时和客服了解处理情况,尊重保护知识产权我们共同努力。
2、文档的总页数、文档格式和文档大小以系统显示为准(内容中显示的页数不一定正确),网站客服只以系统显示的页数、文件格式、文档大小作为仲裁依据,个别因单元格分列造成显示页码不一将协商解决,平台无法对文档的真实性、完整性、权威性、准确性、专业性及其观点立场做任何保证或承诺,下载前须认真查看,确认无误后再购买,务必慎重购买;若有违法违纪将进行移交司法处理,若涉侵权平台将进行基本处罚并下架。
3、本站所有内容均由用户上传,付费前请自行鉴别,如您付费,意味着您已接受本站规则且自行承担风险,本站不进行额外附加服务,虚拟产品一经售出概不退款(未进行购买下载可退充值款),文档一经付费(服务费)、不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
4、如你看到网页展示的文档有www.zixin.com.cn水印,是因预览和防盗链等技术需要对页面进行转换压缩成图而已,我们并不对上传的文档进行任何编辑或修改,文档下载后都不会有水印标识(原文档上传前个别存留的除外),下载后原文更清晰;试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓;PPT和DOC文档可被视为“模板”,允许上传人保留章节、目录结构的情况下删减部份的内容;PDF文档不管是原文档转换或图片扫描而得,本站不作要求视为允许,下载前自行私信或留言给上传者【自信****多点】。
5、本文档所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用;网站提供的党政主题相关内容(国旗、国徽、党徽--等)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
6、文档遇到问题,请及时私信或留言给本站上传会员【自信****多点】,需本站解决可联系【 微信客服】、【 QQ客服】,若有其他问题请点击或扫码反馈【 服务填表】;文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“【 版权申诉】”(推荐),意见反馈和侵权处理邮箱:1219186828@qq.com;也可以拔打客服电话:4008-655-100;投诉/维权电话:4009-655-100。