发明名称 智能小车点镇定控制方法
摘要 本发明公开了一种智能小车的点镇定控制方法,在运动平面上采用Euler-Lagrange方程建立全局坐标系下智能小车的运动学模型和动力学模型;通过运动几何分析的方法建立极坐标系下小车的位姿误差模型;然后针对极坐标位姿误差方程,利用Backstepping技术,分别使所构造的Lyapunov方程导数否定来设计运动学和动力学控制器;最后把神经动力学模型融合到控制规律中,设计具有实用全局渐近稳定的新型点镇定控制器。本发明解决传统方法在点镇定控制时不能镇定到任意目标点以及初始误差存在引起的速度和力矩突变问题,可以使小车更符合实际、快速地镇定到目标点。
申请公布号 CN101794153B 申请公布日期 2011.07.27
申请号 CN201010119549.4 申请日期 2010.03.05
申请人 北京化工大学 发明人 曹政才;赵应涛;朱群雄;蒋昌俊;汪镭
分类号 G05D1/02(2006.01)I;G05B13/04(2006.01)I 主分类号 G05D1/02(2006.01)I
代理机构 北京思海天达知识产权代理有限公司 11203 代理人 楼艮基
主权项 1.一种智能小车点镇定控制方法,其特征在于:包含以下步骤:(1):在运动平面上采用Euler-Lagrange方程建立全局坐标系下智能小车的运动学模型和动力学模型;所述模型包括:小车的位置为(x,y),小车方向角θ,小车的线速度v和小车的角速度w;受非完整约束的智能小车模型用Euler-Lagrange方程表示;(2):通过运动几何分析的方法建立极坐标系下小车的位姿误差模型;所述模型包括;小车期望位姿与当前位姿之间的距离ρ,车体期望方向角与当前方向角的差值φ,小车当前朝向与ρ的夹角α,该误差模型通过运动几何学分析得到;(3):然后针对步骤(1)中的小车模型和步骤(2)中的极坐标位姿误差方程,利用Backstepping技术,分别使所构造的Lyapunov方程导数否定来设计运动学和动力学控制器;其中,运动学控制器的设计为:运动学控制器的设计针对智能小车极坐标位姿误差模型,为动力学控制器提供参考速度和角速度,根据Backstepping方法,选取如下Lyapunov候选函数<img file="FSB00000494276900011.GIF" wi="563" he="108" />k<sub>1</sub>,k<sub>2</sub>>0        (11)可知当ρ,α,φ都等于零时,V<sub>1</sub>=0,否则(11)式正定;结合(10)式:<img file="FSB00000494276900012.GIF" wi="519" he="257" />对方程(11)求导有<img file="FSB00000494276900013.GIF" wi="463" he="68" /><img file="FSB00000494276900014.GIF" wi="1384" he="134" />选取v=k<sub>1</sub>ρcosα,则<img file="FSB00000494276900015.GIF" wi="1563" he="124" />令<img file="FSB00000494276900016.GIF" wi="662" he="160" />(14)<img file="FSB00000494276900017.GIF" wi="579" he="143" />那么(13)式变成为<img file="FSB00000494276900021.GIF" wi="1361" he="60" />因此选择<img file="FSB00000494276900022.GIF" wi="1295" he="194" />由(15)式可知,该系统渐近稳定;其中,动力学控制器的设计为:该控制器是把运动学控制器的输出<img file="FSB00000494276900023.GIF" wi="248" he="59" />作为参考输入,输出为力矩<img file="FSB00000494276900024.GIF" wi="279" he="58" />使得t→∞时,<img file="FSB00000494276900025.GIF" wi="155" he="51" />设定Lyapunov候选函数为:<img file="FSB00000494276900026.GIF" wi="1291" he="109" />其中,<img file="FSB00000494276900027.GIF" wi="436" he="57" />对(17)微分,并考虑(7)式,<img file="FSB00000494276900028.GIF" wi="242" he="58" />其中,<img file="FSB00000494276900029.GIF" wi="233" he="58" />为车体驱动力矩;则有<img file="FSB000004942769000210.GIF" wi="322" he="62" /><img file="FSB000004942769000211.GIF" wi="1374" he="66" /><img file="FSB000004942769000212.GIF" wi="1062" he="80" />选取<img file="FSB000004942769000213.GIF" wi="1174" he="110" />则(18)变为<img file="FSB000004942769000214.GIF" wi="1441" he="109" />其中,<img file="FSB000004942769000215.GIF" wi="264" he="62" />可由(16)式得到,且正常数矩阵<img file="FSB000004942769000216.GIF" wi="424" he="142" />因此选择<img file="FSB000004942769000217.GIF" wi="1169" he="165" />作为点镇定控制规律,该闭环系统能全局渐近稳定; (4):最后把神经动力学模型融合到步骤(3)控制规律中,用该模型代替控制规律中的误差项,并设模型表达式的初值为零,完成整个控制规律的设计。
地址 100029 北京市北三环东路15号北京化工大学81号信箱