CN114115261B - 一种时间可调节的机器人跟踪滑模控制方法 - Google Patents
一种时间可调节的机器人跟踪滑模控制方法 Download PDFInfo
- Publication number
- CN114115261B CN114115261B CN202111386700.5A CN202111386700A CN114115261B CN 114115261 B CN114115261 B CN 114115261B CN 202111386700 A CN202111386700 A CN 202111386700A CN 114115261 B CN114115261 B CN 114115261B
- Authority
- CN
- China
- Prior art keywords
- robot
- time
- sliding mode
- control
- angular velocity
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 48
- 238000009795 derivation Methods 0.000 claims description 12
- 230000009471 action Effects 0.000 claims description 7
- 101100129500 Caenorhabditis elegans max-2 gene Proteins 0.000 claims description 3
- 101100083446 Danio rerio plekhh1 gene Proteins 0.000 claims description 3
- 230000008859 change Effects 0.000 claims description 3
- 238000011217 control strategy Methods 0.000 claims description 3
- 230000000087 stabilizing effect Effects 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 11
- 238000004088 simulation Methods 0.000 description 8
- 238000012800 visualization Methods 0.000 description 4
- 238000013461 design Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000000750 progressive effect Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000001052 transient effect Effects 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000002401 inhibitory effect Effects 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
本发明提出一种时间可调节的机器人跟踪滑模控制方法,包括以下步骤;步骤S1、建立控制机器人移动所需的运动学模型及机器人达成理想轨迹所需的运动学模型;步骤S2、以建立的运动学模型建立机器人的位姿误差系统;步骤S3、将位姿误差系统分为角速度误差系统和线速度误差系统;步骤S4、设计基于滑模控制理论和预定时间控制理论的角速度控制器、线速度控制器;包括步骤S41、角速度控制器创建为时间可调节的角速度滑模控制器,用于提升机器人的角速度控制效率;步骤S42、线速度控制器创建为时间可调节的线速度滑模控制器,用于解决以二阶误差系统控制机器人时存在的终端奇异性问题;本发明具有快速收敛、收敛时间可调节、收敛时间上限估计更精确的优点。
Description
技术领域
本发明涉及机器人技术领域,尤其是一种时间可调节的机器人跟踪滑模控制方法。
背景技术
随着现代工业的快速发展,控制理论作为一门基础学科,被成熟的应用在各个领域。例如在工业上,有仓库分拣机器人、电力系统控制等;在军事上,有飞行器控制、导弹控制等。起初,对于大部分的物理系,都是进行Lyapunov渐进稳定性分析。虽然说渐进稳定表明系统能在无限时间间隔内达到稳定的结果,但无法实现在有限时间间隔内实现系统的暂态性。因此,学者们渐渐地把目光转向研究系统的暂态性,提出了有限时间稳定性(Finite-tine Stability)理论。有限时间稳定性将系统的收敛时间限定在某一数值区间内,收敛时间是一个与系统初始条件相关的函数。然而,在许多实际的工程中,系统的初始条件是难以获得的,并且若系统的初始条件趋于无穷大,那么收敛时间也趋于无穷大。因此从某种意义上讲,此系统还是无限时间收敛的。因此,科学家在2012年提出了一种固定时间稳定性(Fixed-time Stability)理论,该理论的收敛时间只依赖于系统的参数,与初始条件是无关的,实现了任意初始条件的固定时间稳定。但在一般情况下,很难找到系统参数与收敛时间之间的直接关系,从而导致对收敛时间的估计不准确,难以调整和无法预测。所以,通过调整系统参数以达到期望的收敛时间并不是一件简单的任务。从此,一种特殊的固定时间稳定性理论成为了科学家们的研究热点,即预定时间稳定性(Predefined-timeStability)。虽然预定时间稳定性理论被应用到了许多系统上,但是关于非完整轮式移动机器人的轨迹跟踪问题还没有得到应用。综上所述,以非完整轮式移动机器人为被控对象,研究一种拥有快速收敛、可调节收敛时间和更精确的收敛时间上限估计的控制方法是十分有意义的。
发明内容
本发明提出一种时间可调节的机器人跟踪滑模控制方法,克服了二阶系统在进行时间可调节的滑模控制器设计时的奇异性问题,利用连续函数代替符号函数的方法,消除了滑模控制的抖振现象。并且建立了系统参数与收敛时间之间的直接关系,便于用户直接调整系统的收敛时间。
本发明采用以下技术方案。
一种时间可调节的机器人跟踪滑模控制方法,用于控制非完整轮式移动机器人按期望的理想轨迹移动,控制中的收敛时间可调节,包括以下步骤;
步骤S1、建立控制机器人移动所需的运动学模型及机器人达成理想轨迹所需的运动学模型;
步骤S2、以所建立的运动学模型建立机器人的位姿误差系统;
步骤S3、将位姿误差系统分为角速度误差系统和二阶误差系统;
步骤S4、设计基于滑模控制理论和预定时间控制理论的角速度控制器、线速度控制器;包括
步骤S41、角速度控制器创建为时间可调节的角速度滑模控制器,用于提升机器人的角速度控制效率;
步骤S42、线速度控制器创建为时间可调节的线速度滑模控制器,用于解决以二阶误差系统控制机器人时存在的终端奇异性问题。
所述非完整轮式移动机器人的行驶轮为两个驱动轮和两个万向轮,机器人的控制器通过对两个驱动轮的控制实现机器人的运动控制;
步骤S1的运动学模型中,机器人移动的约束方程为
控制机器人移动的运动方程为
其中,控制输入为[v w]T;v表示移动机器人的线速度;w表示移动机器人的角速度;
机器人移动的理想轨迹方程表示为
其中,控制输入为[vd wd]T;vd表示理想的线速度;wd表示理想的角速度。
所述步骤S2中,移动机器人的真实位姿为P=[x y θ]T,移动机器人按期望的理想轨迹移动的期望位姿为Pd=[xd yd θd]T;移动机器人的位姿误差向量表示为Pe=[xe ye θe]T;当位姿误差收敛到零时,即实现了移动机器人按期望的理想轨迹移动的轨迹跟踪控制;[xe ye θe]T为期望机器人在局部坐标系中的位姿坐标,根据坐标变化公式可得:
对pe进行求导,得:
所述步骤S3中,基于级联控制理论,将位姿误差系统分为一阶角速度误差系统和二阶位置误差子系统;
一阶角速度误差系统以公式表述为
首先,一阶角速度误差系统在控制器的作用下实现收敛,即,θe=0;二阶位置误差子系统受到一阶角速度误差系统的影响,系统简化为:
所述步骤S4中,滑模控制器基于滑模变结构控制,使用控制不连续的控制策略;
步骤S41具体为:角速度滑模控制器为一阶角速度误差系统,滑模面选择为:s1=θe;
根据一阶子系统和预定时间理论,设计以如下公式表述的时间可调节的角速度滑模控制器:
其中a0,b0,c0,d0>0,p0,q0,m0,n0是正奇数,并且满足p0<q0,m0>n0;令μ0=p0/q0,ν0=m0/n0且
其中Tc01和Tc02是用户期望的跟踪时间,角度跟踪误差θe将在期望时间内收敛,并且满足:
Tc0<Tmax0=Tc01+Tc02
设计Lyapunov函数为:
V(θe)=|θe| 公式九;
公式变换为
当0≤|θe|<1时,对公式九求导:
若θe=0,那么若θe≠0,那么:
符合预定时间稳定性定理;
当|θe|≥1时,对公式九进行求导:
符合预定时间稳定性定理;同理滑模面s1也满足预定时间稳定性理论;
步骤S42具体为:线速度滑模控制器为二阶误差系统,将控制器应用在机器人上,控制其偏航角转动,使得机器人的实际角速度w逐步与期望的角速度wd同步,最终完成对期望角速度的跟踪;二阶误差系统简化为:
设有
使系统实现全局预定时间稳定,其中a1,b1,c1,d1>0,p1,q1,m1,n1为实正奇数,并且满足p1=q1,m1>n1;令μ1=p1/q1,ν1=m1/n1,且
其中Tc11和Tc12是用户期望的跟踪时间,且Tc1<Tmax1=Tc11+Tc12;
公式十五转变为:
设Lyapunov函数为:V(ye)=|ye| 公式十八;
当0≤|ye|<1时,对公式十八进行求导:
若ye=0,那么若ye≠0,那么:
符合预定时间稳定性定理;
当|ye|≥1时,对公式十八进行求导:
符合预定时间稳定性定理;
设计如下滑模面:
对滑模面s2进行求导得:
则时间可调节的线速度滑模控制器设计如下:
公式二十四;
其中,a2,b2,c2,d2>0,p2,q2,m2,n2是正奇数,并且满足p2<q2,m2>n2。令μ2=p2/q2,ν2=m2/n2,且
其中Tc21和Tc22是用户期望的跟踪时间,且Tc2<Tmax2=Tc21+Tc22;
设Lyapunov函数为:V(s2)=|s2| 公式二十五;
当0≤|s2|<1时,对公式二十五进行求导:
将线速度控制器代入得
若s2=0,那么若s2≠0,那么
符合预定时间稳定性定理;
当|s2|≥1时,对公式二十五进行求导:
将线速度控制器代入得:
所述控制方法中,机器人跟踪理想轨迹移动时,其调节参数与收敛时间之间存在直接对应关系,所述收敛时间的上限估算值为可调节参数,使用户可直接调整机器人用于跟踪理想轨迹的动作时间。
所述机器人的移动控制中没有对机器人侧移动作的控制。
本发明提供一种时间可调节的机器人跟踪滑模控制方法,克服了现有技术中采用固定时间理论设置机器人的轨迹跟踪控制器收敛速度较慢,控制效率较低。并且无法对机器人轨迹跟踪的时间进行调节控制,缺少控制灵活性的缺点,本发明所述方法的控制理论将传统的固定时间稳定性理论转化为分段的控制形式,并且加入了常数控制项c0、d0,因此与传统的固定时间轨迹跟踪相比,其收敛速度更快,控制效率更高,能够实现快速收敛、可调节收敛时间和更精确的收敛时间上限估计。
本发明对抑制系统的抖振现象有显著的效果,并通过加入一个常数项,保证系统在终端收敛时不会有发散的现象,从而解决了二阶系统在进行滑模设计时的终端奇异性问题。
本发明还具有以下优点。
1、本发明将传统的固定时间控制律转化为分段形式,并加入一个常数项,以提高非线性系统的收敛速度,并提高系统的收敛时间上限估计精度。此外,还解决了二阶系统在进行滑模设计时出现的奇异性问题,使得构造的滑模面函数更加简单;
2、本发明在二阶子系统的滑模变结构控制设计中,提出一种利用连续的Lyapunov函数进行收敛的方法,对去除抖振现象有显著的效果;
3、本发明建立调谐增益与收敛时间之间的直接关系,将收敛时间上限估计的复杂表达式转化为一个可调节参数,便于用户调整机器人轨迹的跟踪时间,控制灵活性更好。
附图说明
下面结合附图和具体实施方式对本发明进一步详细的说明:
附图1为本发明中非完整轮式移动机器人的轨迹跟踪控制框示意图;
附图2为本发明中非完整轮式移动机器人的运动学模型示意图;
附图3为本发明中非完整轮式移动机器人的位姿误差示意图;
附图4为本发明实施例1中,当Tc0=2s,Tc1=4s,Tc2=4s时,移动机器人轨迹跟踪结果示意图;
附图5的(a)为本发明实施例1中,当Tc0=2s,Tc1=4s,Tc2=4s时,跟踪误差θe的演化曲线;(b)为本发明实施例1中,当Tc0=2s,Tc1=4s,Tc2=4s时,跟踪误差xe的演化曲线;(c)为本发明实施例1中,当Tc0=2s,Tc1=4s,Tc2=4s时,跟踪误差ye的演化曲线;
附图的6(a)为本发明实施例1中,当Tc0=2s,Tc1=4s,Tc2=4s时,控制输入w的演化曲线;(b)为本发明实施例1中,当Tc0=2s,Tc1=4s,Tc2=4s时,控制输入v的演化曲线;
附图7为本发明实施例1中,当Tc0=4s,Tc1=8s,Tc2=8s时,移动机器人轨迹跟踪结果示意图;
附图8的(a)为本发明实施例1中,当Tc0=4s,Tc1=8s,Tc2=8s时,跟踪误差θe的演化曲线;(b)为本发明实施例1中,当Tc0=4s,Tc1=8s,Tc2=8s时,跟踪误差xe的演化曲线;(c)为本发明实施例1中,当Tc0=4s,Tc1=8s,Tc2=8s时,跟踪误差ye的演化曲线;
附图9的(a)为本发明实施例1中,当Tc0=4s,Tc1=8s,Tc2=8s时,控制输入w的演化曲线;(b)为本发明实施例1中,当Tc0=4s,Tc1=8s,Tc2=8s时,控制输入v的演化曲线;
附图10为本发明实施例1中,不同角速度控制器作用下的角度误差收敛速率示意图;
附图11为本发明实施例1中,不同角速度控制器下的误差平方积分示意图;
附图12为本发明实施例2中,机器人Turtlebot的实际实验硬件平台示意图;
附图13的(a)为本发明实施例2中,机器人Turtlebot在室内进行实际实验的初始位姿状态;(b)为本发明实施例2中,机器人Turtlebot在Rviz下的初始位姿状态;
附图14的(a)为本发明实施例2中,当Tc0=3s,Tc1=6s,Tc2=6s时,轨迹跟踪结果的Rviz可视化示意图;(b)为本发明具体实施例2中,当Tc0=3s,Tc1=6s,Tc2=6s时,根据里程计反馈信息所画的轨迹跟踪示意图;
附图15的(a)为本发明具体实施例2中,当Tc0=5s,Tc1=10s,Tc2=10s时,轨迹跟踪结果的Rviz可视化示意示意图;(b)为本发明具体实施例2中,当Tc0=5s,Tc1=10s,Tc2=10s时,根据里程计反馈信息所画的轨迹跟踪示意图。
具体实施方式
如图所示,一种时间可调节的机器人跟踪滑模控制方法,用于控制非完整轮式移动机器人按期望的理想轨迹移动,控制中的收敛时间可调节,包括以下步骤;
步骤S1、建立控制机器人移动所需的运动学模型及机器人达成理想轨迹所需的运动学模型;
步骤S2、以所建立的运动学模型建立机器人的位姿误差系统;
步骤S3、将位姿误差系统分为角速度误差系统和二阶误差系统;
步骤S4、设计基于滑模控制理论和预定时间控制理论的角速度控制器、线速度控制器;包括
步骤S41、角速度控制器创建为时间可调节的角速度滑模控制器,用于提升机器人的角速度控制效率;
步骤S42、线速度控制器创建为时间可调节的线速度滑模控制器,用于解决以二阶误差系统控制机器人时存在的终端奇异性问题。
所述非完整轮式移动机器人的行驶轮为两个驱动轮和两个万向轮,机器人的控制器通过对两个驱动轮的控制实现机器人的运动控制;
步骤S1的运动学模型中,机器人移动的约束方程为
控制机器人移动的运动方程为
其中,控制输入为[v w]T;v表示移动机器人的线速度;w表示移动机器人的角速度;
机器人移动的理想轨迹方程表示为
其中,控制输入为[vd wd]T;vd表示理想的线速度;wd表示理想的角速度。
所述步骤S2中,移动机器人的真实位姿为P=[x y θ]T,移动机器人按期望的理想轨迹移动的期望位姿为Pd=[xd yd θd]T;移动机器人的位姿误差向量表示为Pe=[xe ye θe]T;当位姿误差收敛到零时,即实现了移动机器人按期望的理想轨迹移动的轨迹跟踪控制;[xe ye θe]T为期望机器人在局部坐标系中的位姿坐标,根据坐标变化公式可得:
对pe进行求导,得:
所述步骤S3中,基于级联控制理论,将位姿误差系统分为一阶角速度误差系统和二阶位置误差子系统;
一阶角速度误差系统以公式表述为
首先,一阶角速度误差系统在控制器的作用下实现收敛,即,θe=0;二阶位置误差子系统受到一阶角速度误差系统的影响,系统简化为:
所述步骤S4中,滑模控制器基于滑模变结构控制,使用控制不连续的控制策略;
步骤S41具体为:角速度滑模控制器为一阶角速度误差系统,滑模面选择为:s1=θe;
根据一阶子系统和预定时间理论,设计以如下公式表述的时间可调节的角速度滑模控制器:
其中a0,b0,c0,d0>0,p0,q0,m0,n0是正奇数,并且满足p0<q0,m0>n0;令μ0=p0/q0,ν0=m0/n0且
其中Tc01和Tc02是用户期望的跟踪时间,角度跟踪误差θe将在期望时间内收敛,并且满足:
Tc0<Tmax0=Tc01+Tc02
设计Lyapunov函数为:
V(θe)=|θe| 公式九;
公式变换为
当0≤|θe|<1时,对公式九求导:
若θe=0,那么若θe≠0,那么:
符合预定时间稳定性定理;
当|θe|≥1时,对公式九进行求导:
符合预定时间稳定性定理;同理滑模面s1也满足预定时间稳定性理论;
步骤S42具体为:线速度滑模控制器为二阶误差系统,将控制器应用在机器人上,控制其偏航角转动,使得机器人的实际角速度w逐步与期望的角速度wd同步,最终完成对期望角速度的跟踪;二阶误差系统简化为:
设有
使系统实现全局预定时间稳定,其中a1,b1,c1,d1>0,p1,q1,m1,n1为实正奇数,并且满足p1=q1,m1>n1;令μ1=p1/q1,ν1=m1/n1,且
/>
其中Tc11和Tc12是用户期望的跟踪时间,且Tc1<Tmax1=Tc11+Tc12;
公式十五转变为:
设Lyapunov函数为:V(ye)=|ye| 公式十八;
当0≤|ye|<1时,对公式十八进行求导:
若ye=0,那么若ye≠0,那么:
符合预定时间稳定性定理;
当|ye|≥1时,对公式十八进行求导:
符合预定时间稳定性定理;
设计如下滑模面:
对滑模面s2进行求导得:
则时间可调节的线速度滑模控制器设计如下:
公式二十四;
其中,a2,b2,c2,d2>0,p2,q2,m2,n2是正奇数,并且满足p2<q2,m2>n2。令μ2=p2/q2,ν2=m2/n2,且
其中Tc21和Tc22是用户期望的跟踪时间,且Tc2<Tmax2=Tc21+Tc22;
设Lyapunov函数为:V(s2)=|s2| 公式二十五;
当0≤|s2|<1时,对公式二十五进行求导:
将线速度控制器代入得
若s2=0,那么若s2≠0,那么
符合预定时间稳定性定理;
当|s2|≥1时,对公式二十五进行求导:
将线速度控制器代入得:
所述控制方法中,机器人跟踪理想轨迹移动时,其调节参数与收敛时间之间存在直接对应关系,所述收敛时间的上限估算值为可调节参数,使用户可直接调整机器人用于跟踪理想轨迹的动作时间。
所述机器人的移动控制中没有对机器人侧移动作的控制。
为了更加直观的显示本发明提出的一种时间可调节的机器人跟踪滑模控制方法的有效性和可行性,本发明使用一组MATLAB/Simulink仿真和一组Rviz可视化仿真对此方法进行验证。
实施例1:
使用上述的方法并基于MATLAB/Simulink对非完整移动机器人进行时间可调节的滑模控制仿真,初始位姿误差设置为[xe(0),ye(0),θe(0)]T=[2,2,π/4]T,理想的角速度为wd=1.0rad/s,理想的线速度为vd=5.0m/s,采用角速度控制器(8)和线速度控制器(24)进行机器人的时间可调节的跟踪控制。控制器参数如下:
a0=1.3,a1=2.0,a2=1.0,b0=1,b1=2.0,b2=1.0,c0=0.1,c1=0.01,d0=0.1,d1=0.01,p0=5,p1=1,p2=3,q0=7,q1=1,q2=5,m0=11,m1=9,m2=5,n0=7,n1=7,n2=3
。当设置调节参数为Tc0=2s,Tc1=4s,Tc2=4s时,仿真示例结果如图4至图6所示,图4为移动机器人的轨迹跟踪结果,图5(a)为跟踪误差θe的演化曲线,图5(b)为跟踪误差xe的演化曲线,图5(c)为跟踪误差ye的演化曲线,图6(a)为控制输入w的演化曲线,图6(b)为控制输入v的演化曲线。当调节参数为Tc0=4s,Tc1=8s,Tc2=8s时,仿真示例结果如图7至图9所示,图7为移动机器人的轨迹跟踪结果,图8(a)为跟踪误差θe的演化曲线,图8(b)为跟踪误差xe的演化曲线,图8(c)为跟踪误差ye的演化曲线,图9(a)为控制输入w的演化曲线,图9(b)为控制输入v的演化曲线。可以很明显的看出移动机器人都在各自设置的期望时间内完成对理想轨迹的跟踪控制。当去掉预定参数后,时间可调控制器就变为固定时间控制器,与文献“Huang W,Yang Y,Hua C.Fixed-time tracking control approach design fornonholonomic mobile robot[C].the 35th Chinese Control Conference,2015:27-30”的固定时间控制器相比,本方法的收敛速度要比现有的方法快,如图10所示。误差平方积分(Integral Square Error,ISE)作为评判两个稳态系统性能的好坏指标,本方法拥有更小的ISE,有更好的性能指标,如图11所示。以上的具体实施例结果都符合本方法的研究预期。
实施例2:
使用上述方法对Turtlebot进行室内环境的时间可调节的跟踪滑模控制,搭建机器人,机器人由一台华硕FX50笔记本作为机器人控制系统(控制器),kobuki移动底座作为机器人驱动系统,组成的机器人实验平台如图12所示。设置Turtlebot的初始位姿误差设置为[xe(0),ye(0),θe(0)]T=[1,0.5,-π/4]T,实际的Turtlebot初始位姿如图13(a)所示,在Rviz可视化下Turtlebot的初始位姿如图13(b)所示,理想的角速度为wd=0.4rad/s,理想的线速度为vd=0.2m/s,采用角速度控制器(8)和线速度控制器(24)进行机器人的时间可调节的跟踪控制。控制器参数如下:
a0=0.5,a1=0.8,a2=0.5,b0=0.7,b1=0.6,b2=0.3,p0=5,p1=1,p2=3,q0=7,q1=1,q2=5,m0=11,m1=7,m2=5,n0=7,n1=5,n2=3
。当调节参数为Tc0=3s,Tc1=6s,Tc2=6s时,仿真结果如图14所示,图14(a)为轨迹跟踪结果的Rviz可视化示意图,图14(b)为根据里程计反馈信息所画的轨迹跟踪图。当调节参数为Tc0=5s,Tc1=10s,Tc2=10s时,仿真结果如图15所示,图15(a)为轨迹跟踪结果的Rviz可视化示意图,图15(b)为根据里程计反馈信息所画的轨迹跟踪图。轨迹跟踪的误差收敛时间如表1所示。对仿真结果进行分析,得出Turtlebot机器人能够在用户设置的期望时间内完成对理想轨迹的跟踪。具体实施例结果符合本方法的研究预期。
表1不同预定参数的轨迹跟踪实验结果
以上所述,仅是本发明的较佳实施例而已,并非是对本发明作其它形式的限制,任何熟悉本专业的技术人员可能利用上述揭示的技术内容加以变更或改型为等同变化的等效实施例。但是凡是未脱离本发明技术方案内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化与改型,仍属于本发明技术方案的保护范围。
Claims (3)
1.一种时间可调节的机器人跟踪滑模控制方法,用于控制非完整轮式移动机器人按期望的理想轨迹移动,控制中的收敛时间可调节,其特征在于:包括以下步骤;
步骤S1、建立控制机器人移动所需的运动学模型及机器人达成理想轨迹所需的运动学模型;
步骤S2、以所建立的运动学模型建立机器人的位姿误差系统;
步骤S3、将位姿误差系统分为角速度误差系统和二阶误差系统;
步骤S4、设计基于滑模控制理论和预定时间控制理论的角速度控制器、线速度控制器;包括
步骤S41、角速度控制器创建为时间可调节的角速度滑模控制器,用于提升机器人的角速度控制效率;
步骤S42、线速度控制器创建为时间可调节的线速度滑模控制器,用于解决以二阶误差系统控制机器人时存在的终端奇异性问题;
所述非完整轮式移动机器人的行驶轮为两个驱动轮和两个万向轮,机器人的控制器通过对两个驱动轮的控制实现机器人的运动控制;
步骤S1的运动学模型中,机器人移动的约束方程为
控制机器人移动的运动方程为
其中,控制输入为[v w]T;v表示移动机器人的线速度;w表示移动机器人的角速度;
机器人移动的理想轨迹方程表示为
其中,控制输入为[vd wd]T;vd表示理想的线速度;wd表示理想的角速度;
所述步骤S2中,移动机器人的真实位姿为P=[x y θ]T,移动机器人按期望的理想轨迹移动的期望位姿为Pd=[xd yd θd]T;移动机器人的位姿误差向量表示为Pe=[xe ye θe]T;当位姿误差收敛到零时,即实现了移动机器人按期望的理想轨迹移动的轨迹跟踪控制;[xe yeθe]T为期望机器人在局部坐标系中的位姿坐标,根据坐标变化公式可得:
对pe进行求导,得:
所述步骤S3中,基于级联控制理论,将位姿误差系统分为一阶角速度误差系统和二阶误差系统;
一阶角速度误差系统以公式表述为
首先,一阶角速度误差系统在控制器的作用下实现收敛,即,θe=0;二阶误差系统受到一阶角速度误差系统的影响,系统简化为:
所述步骤S4中,滑模控制器基于滑模变结构控制,使用控制不连续的控制策略;
步骤S41具体为:角速度滑模控制器为一阶角速度误差系统,滑模面选择为:s1=θe;
根据一阶角速度误差系统和预定时间理论,设计以如下公式表述的时间可调节的角速度滑模控制器:
其中a0,b0,c0,d0>0,p0,q0,m0,n0是正奇数,并且满足p0<q0,m0>n0;令μ0=p0/q0,ν0=m0/n0且
其中Tc01和Tc02是用户期望的跟踪时间,角度跟踪误差θe将在期望时间内收敛,并且满足:
Tc0<Tmax0=Tc01+Tc02
设计Lyapunov函数为:
V(θe)=|θe| 公式九;
公式变换为
当0≤|θe|<1时,对公式九求导:
若θe=0,那么若θe≠0,那么:
符合预定时间稳定性定理;
当|θe|≥1时,对公式九进行求导:
符合预定时间稳定性定理;同理滑模面s1也满足预定时间稳定性理论;
步骤S42具体为:线速度滑模控制器为二阶误差系统,将控制器应用在机器人上,控制其偏航角转动,使得机器人的实际角速度w逐步与期望的角速度wd同步,最终完成对期望角速度的跟踪;二阶误差系统简化为:
设有
使系统实现全局预定时间稳定,其中a1,b1,c1,d1>0,p1,q1,m1,n1为实正奇数,并且满足p1=q1,m1>n1;令μ1=p1/q1,ν1=m1/n1,且
其中Tc11和Tc12是用户期望的跟踪时间,且Tc1<Tmax1=Tc11+Tc12;
公式十五转变为:
设Lyapunov函数为:V(ye)=|ye| 公式十八;
当0≤|ye|<1时,对公式十八进行求导:
若ye=0,那么若ye≠0,那么:
符合预定时间稳定性定理;
当|ye|≥1时,对公式十八进行求导:
符合预定时间稳定性定理;
设计如下滑模面:
对滑模面s2进行求导得:
则时间可调节的线速度滑模控制器设计如下:
其中,a2,b2>0,p2,q2,m2,n2是正奇数,并且满足p2<q2,m2>n2;令μ2=p2/q2,ν2=m2/n2,且
其中Tc21和Tc22是用户期望的跟踪时间,且Tc2<Tmax2=Tc21+Tc22;
设Lyapunov函数为:V(s2)=|s2| 公式二十五;
当0≤|s2|<1时,对公式二十五进行求导:
将线速度控制器代入得
若s2=0,那么若s2≠0,那么
符合预定时间稳定性定理;
当|s2|≥1时,对公式二十五进行求导:
将线速度控制器代入得:
2.根据权利要求1所述的一种时间可调节的机器人跟踪滑模控制方法,其特征在于:所述控制方法中,机器人跟踪理想轨迹移动时,其调节参数与收敛时间之间存在直接对应关系,所述收敛时间的上限估算值为可调节参数,使用户可直接调整机器人用于跟踪理想轨迹的动作时间。
3.根据权利要求1所述的一种时间可调节的机器人跟踪滑模控制方法,其特征在于:所述机器人的移动控制中没有对机器人侧移动作的控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111386700.5A CN114115261B (zh) | 2021-11-22 | 2021-11-22 | 一种时间可调节的机器人跟踪滑模控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111386700.5A CN114115261B (zh) | 2021-11-22 | 2021-11-22 | 一种时间可调节的机器人跟踪滑模控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114115261A CN114115261A (zh) | 2022-03-01 |
CN114115261B true CN114115261B (zh) | 2024-03-29 |
Family
ID=80439512
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111386700.5A Active CN114115261B (zh) | 2021-11-22 | 2021-11-22 | 一种时间可调节的机器人跟踪滑模控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114115261B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109857100A (zh) * | 2019-01-09 | 2019-06-07 | 合肥工业大学 | 一种基于反演法和快速终端滑模的复合轨迹跟踪控制算法 |
CN110597268A (zh) * | 2019-09-30 | 2019-12-20 | 东南大学 | 一种基于级联系统理论的轮式移动机器人轨迹跟踪控制方法 |
CN111694361A (zh) * | 2020-06-23 | 2020-09-22 | 杭州宇芯机器人科技有限公司 | 基于改进趋近律滑模控制的钢结构柔性探伤机器人轨迹跟踪方法 |
CN111880404A (zh) * | 2020-06-17 | 2020-11-03 | 中国人民解放军军事科学院国防科技创新研究院 | 基于非奇异终端滑膜控制的航天器集群控制方法 |
CN112286229A (zh) * | 2020-10-22 | 2021-01-29 | 上海海事大学 | 一种基于递归滑模的移动机器人有限时间轨迹跟踪控制方法 |
-
2021
- 2021-11-22 CN CN202111386700.5A patent/CN114115261B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109857100A (zh) * | 2019-01-09 | 2019-06-07 | 合肥工业大学 | 一种基于反演法和快速终端滑模的复合轨迹跟踪控制算法 |
CN110597268A (zh) * | 2019-09-30 | 2019-12-20 | 东南大学 | 一种基于级联系统理论的轮式移动机器人轨迹跟踪控制方法 |
CN111880404A (zh) * | 2020-06-17 | 2020-11-03 | 中国人民解放军军事科学院国防科技创新研究院 | 基于非奇异终端滑膜控制的航天器集群控制方法 |
CN111694361A (zh) * | 2020-06-23 | 2020-09-22 | 杭州宇芯机器人科技有限公司 | 基于改进趋近律滑模控制的钢结构柔性探伤机器人轨迹跟踪方法 |
CN112286229A (zh) * | 2020-10-22 | 2021-01-29 | 上海海事大学 | 一种基于递归滑模的移动机器人有限时间轨迹跟踪控制方法 |
Non-Patent Citations (1)
Title |
---|
非完整轮式移动机器人反演滑模轨迹跟踪控制器设计;杨敏等;机械制造与自动化;第44卷(第5期);152-154, 196 * |
Also Published As
Publication number | Publication date |
---|---|
CN114115261A (zh) | 2022-03-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108008720B (zh) | 一种轮式移动机器人的模糊滑模轨迹跟踪控制及方法 | |
CN108161882B (zh) | 一种基于增强现实的机器人示教再现方法及装置 | |
CN108681243B (zh) | 一种机器人轨迹跟踪方法 | |
CN110865641B (zh) | 一种反演滑模控制的轮式移动机器人的轨迹跟踪方法 | |
CN109857100B (zh) | 一种基于反演法和快速终端滑模的复合轨迹跟踪控制算法 | |
CN111650929B (zh) | 一种自适应滑模控制方法、系统及移动机器人控制器 | |
CN107608344B (zh) | 基于轨迹规划的车辆运动控制方法、装置及相关设备 | |
CN106950999B (zh) | 一种采用自抗扰控制技术的移动舞台轨迹跟踪控制方法 | |
CN108614560B (zh) | 一种移动机器人视觉伺服保性能跟踪控制方法 | |
CN109571432A (zh) | 一种基于力传感器的机器人直接示教方法 | |
CN108762219A (zh) | 单舵轮agv点镇定控制方法及装置 | |
CN103935508A (zh) | 一种无人飞行器下降的辅助控制方法及系统 | |
CN113084821A (zh) | 一种基于动力学的喷涂机器人时间最优轨迹规划方法 | |
CN107807522A (zh) | 水下机器人轨迹跟踪反步控制方法 | |
CN114115261B (zh) | 一种时间可调节的机器人跟踪滑模控制方法 | |
CN115202349A (zh) | 基于通信干扰的多移动机器人协同编队控制方法、装置、设备及存储介质 | |
CN107977011A (zh) | 基于分数阶控制算法的四旋翼无人机飞行控制方法 | |
CN111208830A (zh) | 一种轮式移动机器人三闭环编队轨迹跟踪控制方法 | |
Cheng et al. | Trajectory tracking control of nonholonomic mobile robots by backstepping | |
CN114407010B (zh) | 零力控制方法、装置、电子设备及存储介质 | |
CN114114903B (zh) | 一种基于变指数幂次趋近律的板球系统积分终端滑模控制方法 | |
CN103170976B (zh) | 二自由度机器人运动控制方法 | |
CN114102599A (zh) | 基于柔性机械臂的人机交互自适应控制方法和系统 | |
CN112083652A (zh) | 一种多用途轮式移动机器人轨迹跟踪控制方法 | |
Ying et al. | A Human Intention Based Fuzzy Variable Admittance Control System for Physical Human–Robot Interaction |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |