CN109885052A - 基于全向移动机器人运动学建模的误差模型预测控制方法 - Google Patents
基于全向移动机器人运动学建模的误差模型预测控制方法 Download PDFInfo
- Publication number
- CN109885052A CN109885052A CN201910142417.4A CN201910142417A CN109885052A CN 109885052 A CN109885052 A CN 109885052A CN 201910142417 A CN201910142417 A CN 201910142417A CN 109885052 A CN109885052 A CN 109885052A
- Authority
- CN
- China
- Prior art keywords
- model
- error
- omr
- constraint
- omni
- 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.)
- Granted
Links
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种基于全向移动机器人运动学建模的误差模型预测控制方法,所述方法包括以下步骤:S11、建立FM‑OMR四个麦克纳姆轮之间的速度约束运动学模型;S12、建立FM‑OMR的跟踪误差运动学模型;S13、针对FM‑OMR的轨迹跟踪问题,针对跟踪误差运动学模型,设计结合速度约束方程的误差模型预测控制器;S14、根据所述误差模型预测控制器控制全向移动机器人之间的有效轨迹跟踪参数,使全向移动机器人之间的跟踪误差维持不变。本发明针对四个麦克纳姆轮的全向移动机器人提出了一种基于轨迹跟踪误差运动学建模的误差模型预测控制方法,解决了有效轨迹跟踪控制的非完整约束问题,准确性和有效性。
Description
技术领域
本发明涉及全向移动机器人、轨迹跟踪、误差模型预测控制等领域,特别是涉及一种基于轨迹跟踪误差全向移动机器人运动学建模的误差模型预测控制方法。
背景技术
轨迹跟踪控制是为了解决如何将移动机器人的实际位置和方向收敛到期望的参考轨迹的问题。该领域在多智能体协作如多机器人编队和多机器人轨迹规划等方面具有广阔的应用前景。近年来,对轮式移动机器人的轨迹跟踪控制的研究逐渐增多。普通轮式差动驱动移动机器人仅具有两个自由度,狭窄的环境会导致其灵活性和可操作性下降。
与传统的差动驱动机器人相比,全向移动机器人(OMR)能够实现沿任意方向的平移而不旋转。此外,OMR还能够有效地适应小的工作空间并获得高精度的轨迹。因此,它们被广泛部署在拥挤的地区和紧凑的环境中,如仓库、走廊和船舱。OMR由于其优越的移动性而越来越受欢迎。在不久的将来,采用OMR来处理大量任务也指日可待。目前已有人提出一种具有三个全向轮的对称配置的OMR。杰西瓦尔多提出了三个全向轮的OMR的滤波史密斯预测器。虽然这种三轮式OMR结构简单,但其稳定性并不令人满意。
而配备有四个麦克纳姆轮的OMR则显示出相对较好的稳定性。OMR复杂的轮系结构显然增加了与运动控制相关的难度。Yanwen提出了一种四轮全向移动机器人,并设计了基于滑移动力学模型的路径跟踪控制器。同时,Ehsan提出了四轮全向移动机器人的PI-模糊控制器。此外,Vlantis提出了一种具有四个麦克纳姆轮的新型OMR(FM-OMR)。
FM-OMR具有全向移动、稳定性好、承载能力强等优点,在工业上得到了广泛的应用。对于非完整约束系统,刚性约束有可能降低系统的控制性能和稳定性。MPC(模型预测控制)在处理具有各种约束的复杂线性和非线性系统方面具有卓越的性能,并且在以前的工作中得到了广泛的关注。MPC已经被广泛用于移动机器人、拟人机器人、无人驾驶飞行器。
发明内容
本发明的目的是针对现有技术的不足,提供了FM-OMR的运动学模型和四个车轮之间的速度约束关系。考虑四个麦克纳姆轮速度之间的约束关系,在运动学模型的基础上,进一步制定跟踪误差运动学模型。基于轨迹跟踪误差运动学模型的EMPC方案在求解非完整约束问题的同时可以解决其速度约束问题。所述方法优点突出,参数物理意义明确,适用性较强。
本发明采用如下技术方案实现:
基于全向移动机器人运动学建模的误差模型预测控制方法,所述方法包括以下步骤:
S11、建立FM-OMR四个麦克纳姆轮之间的速度约束运动学模型;
S12、建立FM-OMR的跟踪误差运动学模型;
S13、针对FM-OMR的轨迹跟踪问题,针对跟踪误差运动学模型,设计结合速度约束方程的误差模型预测控制器;
S14、根据设计的误差模型预测控制器调整全向移动机器人之间的有效轨迹跟踪参数,使全向移动机器人之间的跟踪误差维持不变。
进一步地,S11步骤所述的FM-OMR四个麦克纳姆轮之间的速度约束运动学模型构建包括:
S111、首先对FM-OMR的结构进行描述;
S112、其次对FM-OMR的速度约束进行描述:
将车轮的转速表示为车轮的平移速度表示为而Vir,i=1,2,3,4,是自由移动辊的切向速度,类似地,我们可以将机器人框架中轮子的合成速度表示为:
V1x=V1m++V1rcosα1V1y=V1rsinα1
V2x=V2m+V2rcosα2V2y=V2rsinα2
V3x=V3m+V3rcosα3V3y=V3rsinα3
V4x=V4m+V4rcosα4V4y=V4rsinα4
其中α1=α3=45,α2=α4=-45,此外,由于轮速与机器人本体的速度是刚性连接的,因此轮速与机器人本体的速度相关,因此,这种相关性可以建立为:
V1x=vx-l1w V1y=vy+l2w
V2x=vx+l1w V2y=vy+l2w
V3x=vx-l1w V3y=vy-l2w
V4x=vx+l1w V4y=vy-l2w
因此,可以获得FM-OMR机体的速度以及四个轮子的角速度的关系如下:
其中R是如下雅可比矩阵:
其中矩阵R不是方阵,因此没有逆矩阵,然而,广义逆矩阵可以表示为:
因此可以得到:
因此,由上面获得:
同样的,可以从上式得到以下等式:
ω1+ω2=ω3+ω4
调整四个麦克纳姆轮各自的速度,可以实现在给定的平面内期望的全向运动,因此,每个轮子的约束产生作用于整个机体,四个麦克纳姆轮之间的速度约束关系由ω1+ω2=ω3+ω4表示,车身速度与四个轮子角速度之间的关系已经得出,机器人本体的速度可以表示如下:
其中,
S113、最后构建FM-OMR的运动学模型:
从上述式子,可以得出非完整FM-OMR的运动学模型如下:
进一步地,S12步骤所述的FM-OMR跟踪误差运动学建模具体过程为:
S121、确定领导者Rr以及跟随者R的物理参数,其中对于领导者小车,有:
其中,
S122、根据领导者以及跟随者在世界坐标系下的位置和角度计算Rr在R坐标系下的相对位置和角度(xe,ye,θe):
其中,(x,y,θ)以及(xr,yr,θr)是分别都是对应于R和Rr的惯性协同坐标系;
S123、根据所得的(xe,ye,θe)计算其导数,建立其导数与输入[u1,u2,u3]之间的状态方程,所述导数表示为:
其中,
a=w1r+w2r+w3r+w4r
b=w1r-w2r-w3r+w4r
c=w1+w2+w3+w4
d=w1-w2-w3+w4
其中,a、b是Rr四个车轮角速度的线性组合,c、d是R四个车轮角速度的线性组合;
则综上四个麦克纳姆轮之间具有速度约束的轨迹跟踪误差运动学模型为:
其中,
u3=wr-w;
S124、通过控制输入[u1,u2,u3],误差状态量[xe,ye,θe]可以收敛到原点。
进一步地,步骤S13中,设计结合速度约束方程的误差模型预测控制器时,连续时变系统用离散时间模型的形式重新表示,每个特征点的离散时间状态空间模型可以表示为:
ze(k+1)=L(k)ze(k)+M(k)u(k)
其中,表示输入向量,表示状态量, 参数n和m表示状态和输入变量的数量;根据采样定理,给定连续时间系统可以用采样周期T离散化,因此,上式可以写成如下形式:
所述状态空间模型中,为了导出给定预测层Np的最优控制序列,损失函数可以表示为:
其中,Δu(k)表示输入向量的增量,有Δu(k)=u(k)-u(k-1),ze(k+j|k)和△u(k+j|k)表示基于当前时间k,在时间k+j,上的预测变量,此外,Nc代表控制层,Np代表预测层,最后,Q和P表示适当的加权矩阵;
从以上式子,可以得出:
定义了如下形式的预测向量:
其中,Np=3,Nc=2,且对于所有k≥0时刻,约束表示如下:
预测状态可以表示为如下形式:
其中,
最终,基于约束条件下代价函数的EMPC算法可通过解以下约束来对问题进行优化:
这取决于:
进一步地,S13步骤所述的误差模型预测控制器中实时的EMPC算法通过以下步骤实现:
S131、选择适当的控制器参数,包括Nc,Np,Q,P,T,T1;
其中,Nc代表控制层参数,Np代表预测层参数;Q,P表示适当的加权矩阵;T为采样周期,T1为控制周期。
S132、解优化问题得到输入增量:
S133、计算得到k时刻时的输入向量;
S134、将计算的u(k)输入到系统中,更新状态向量以及ze的信息;
S135、根据u(k)解出四个电机的角速度[w1,w2,w3,w4];
S136、如果则k=k+1,重新回到步骤S132,否则退出。
进一步地,所述误差模型预测控制器采用机器人操作系统ROS的仿真平台进行仿真验证。
进一步地,所述仿真平台为一台装有机器人操作系统(ROS)的PC电脑,该电脑系统是Ubuntu 14.04,其中数据可视化平台RVIZ是ROS中一款可视化仿真软件。
相比于现有技术方法,本发明的优点和有益效果是:
1、建立了FM-OMR的运动学模型和四个车轮之间的速度约束关系。在运动学模型的基础上,进一步制定根据四个麦克纳姆轮速度之间的约束关系下的跟踪误差运动学模型;
2、基于轨迹跟踪误差运动学模型的EMPC(误差模型预测控制)方案在求解非完整约束的同时可以解决上述速度约束问题;
3、FM-OMR具有全方位、稳定性好、承载能力强等优点,在工业上得到了广泛的应用。本发明提出的控制方法也适用于各种FM-OMR,从而解决了实际工程问题。
附图说明
此处说明的附图用来提供本发明实施例的进一步讲解,构成本申请的一部分,并不构成本发明实施例的限定。在附图中:
图1为全向移动机器人结构示意图。
图2为两个小车坐标系以及参数定义图。
图3为FM-OMR的物理参数示意图。
图4为曲线参考轨迹跟踪仿真实验图。
图5为曲线跟踪实验中相关误差。
图6为四个轮子的角速度和跟随者小车R的四个麦克纳姆轮之间的矢量约束。
图7为前两轮子的角速度之和、后两轮子角速度之和与跟随者小车R的四个麦克纳姆轮之间的矢量约束。
图8为机器人操作系统(ROS)中通过RVIZ软件实验的仿真轨迹图。
图9为FM-OMR跟随者R的物理参数图。
图10为FM-OMR领导者Rr的物理参数图。
具体实施方式
为使本发明的目的、技术方案及优点更加清楚明白,下面结合附图和具体实施例对本发明的发明目的作进一步详细地描述,实施例不能在此一一赘述,但本发明的示意性实施方式及其说明仅用于解释本发明,并不作为对本发明的限定。
实施例
麦克纳姆轮是一种性能优越、应用广泛的全向操纵轮,它由均匀分布在中心轮毂周围的小辊子组成。麦克纳姆轮具有三个自由度,即绕轮轴旋转、绕辊子轴线旋转以及在轮和地面之间滚动。车轮的转动由电机驱动,而辊子则由地面上的摩擦力驱动。因此,当电机驱动轮子旋转时,轮子将沿着垂直于驱动轴的方向前进,而围绕轮子的辊子将沿着各自的轴线前进。
基于全向移动机器人运动学建模的误差模型预测控制方法,所述方法包括以下步骤:
S11、建立FM-OMR四个麦克纳姆轮之间的速度约束运动学模型;
S12、建立FM-OMR的跟踪误差运动学模型;
S13、针对FM-OMR的轨迹跟踪问题,针对跟踪误差运动学模型,设计结合速度约束方程的误差模型预测控制器;
S14、根据设计的误差模型预测控制器调整全向移动机器人之间的有效轨迹跟踪参数,使全向移动机器人之间的跟踪误差维持不变。
具体地,S11步骤所述的FM-OMR四个麦克纳姆轮之间的速度约束运动学模型构建包括:
S111、首先对FM-OMR的结构进行描述;
S112、其次对FM-OMR的速度约束进行描述:
将车轮的转速表示为车轮的平移速度表示为而Vir,i=1,2,3,4,是自由移动辊的切向速度,类似地,我们可以将机器人框架中轮子的合成速度表示为:
V1x=V1m+V1rcosα1V1y=V1rsinα1
V2x=V2m+V2rcosα2V2y=V2rsinα2
V3x=V3m+V3rcosα3V3y=V3rsinα3
V4x=V4m+V4rcosα4V4y=V4rsinα4
其中α1=α3=45,α2=α4=-45,此外,由于轮速与机器人本体的速度是刚性连接的,因此轮速与机器人本体的速度相关,因此,这种相关性可以建立为:
V1x=vx-l1w V1y=vy+l2w
V2x=vx+l1w V2y=vy+l2w
V3x=vx-l1w V3y=vy-l2w
V4x=vx+l1w V4y=vy-l2w
因此,可以获得FM-OMR机体的速度以及四个轮子的角速度的关系如下:
其中R是如下雅可比矩阵:
其中矩阵R不是方阵,因此没有逆矩阵,然而,广义逆矩阵可以表示为:
因此可以得到:
因此,由上面获得:
同样的,可以从上式得到以下等式:
ω1+ω2=ω3+ω4
调整四个麦克纳姆轮各自的速度,可以实现在给定的平面内期望的全向运动,因此,每个轮子的约束产生作用于整个机体,四个麦克纳姆轮之间的速度约束关系由ω1+ω2=ω3+ω4表示,车身速度与四个轮子角速度之间的关系已经得出,机器人本体的速度可以表示如下:
其中,
S113、最后构建FM-OMR的运动学模型:
从上述式子,可以得出非完整FM-OMR的运动学模型如下:
具体地,S12步骤所述的FM-OMR跟踪误差运动学建模具体过程为:
S121、确定领导者Rr以及跟随者R的物理参数,其中对于领导者小车,有:
S122、根据领导者以及跟随者在世界坐标系下的位置和角度计算Rr在R坐标系下的相对位置和角度(xe,ye,θe):
其中,(x,y,θ)以及(xr,yr,θr)是分别都是对应于R和Rr的惯性协同坐标系;
S123、根据所得的(xe,ye,θe)计算其导数,建立其导数与输入[u1,u2,u3]之间的状态方程,所述导数表示为:
其中,
a=w1r+w2r+w3r+w4r
b=w1r-w2r-w3r+w4r
c=w1+w2+w3+w4
d=w1-w2-w3+w4
其中,a、b是Rr四个车轮角速度的线性组合,c、d是R四个车轮角速度的线性组合;
则综上四个麦克纳姆轮之间具有速度约束的轨迹跟踪误差运动学模型为:
其中,
u3=wr-w;
S124、通过控制输入[u1,u2,u3],误差状态量[xe,ye,θe]可以收敛到原点。
具体地,步骤S13中,MPC(模型预测控制)过程可以看成是寻找损失函数的最优解。在该搜索空间的每个采样实例处,N个未来采样实例的输出可从系统模型获得,而损失函数是通过预测和真实系统状态输出之间的估计误差得到的。因此,通过最小化损失函数,导出即时N个采样实例的最优控制输入。值得强调的是,只有第一控制向量被当作系统的输入,这个过程是迭代执行的,并且在每次迭代中实现优化,直到获得最优解。
设计结合速度约束方程的误差模型预测控制器时,连续时变系统用离散时间模型的形式重新表示,每个特征点的离散时间状态空间模型可以表示为:
ze(k+1)=L(k)ze(k)+M(k)u(k)
其中,表示输入向量,表示状态量, 参数n和m表示状态和输入变量的数量;根据采样定理,给定连续时间系统可以用采样周期T离散化,因此,上式可以写成如下形式:
所述状态空间模型中,为了导出给定预测层Np的最优控制序列,损失函数可以表示为:
其中,Δu(k)表示输入向量的增量,有Δu(k)=u(k)-u(k-1)。ze(k+j|k)和△u(k+j|k)表示基于当前时间k,在时间k+j,上的预测变量,此外,Nc代表控制层,Np代表预测层,最后,Q和P表示适当的加权矩阵,T为采样周期;
从以上式子,可以得出:
定义了如下形式的预测向量:
其中,Np=3,Nc=2。且对于所有k≥0时刻,约束表示如下:
其中状态量ze的最大值和最小值输入向量的最大值和最小值输入向量的增量Δu(k)的最小值和最大值均为某一给定的常数;
预测状态可以表示为如下形式:
其中,
最终,基于约束条件下代价函数的EMPC算法可通过解以下约束来对问题进行优化:
这取决于:
具体地,S13步骤所述的误差模型预测控制器中实时的EMPC算法通过以下步骤实现:
S131、选择适当的控制器参数,包括Nc,Np,Q,P,T,T1;其中,Nc代表控制层参数,Np代表预测层参数;Q,P表示适当的加权矩阵;T为采样周期,T1为控制周期。
S132、解优化问题得到输入增量:
S133、计算得到k时刻时的输入向量;
S134、将计算的u(k)输入到系统中,更新状态向量以及ze的信息;
S135、根据u(k)解出四个电机的角速度[w1,w2,w3,w4];
S136、如果则k=k+1,重新回到步骤S132,否则退出。
具体地,所述误差模型预测控制器采用机器人操作系统ROS的仿真平台进行仿真验证。所述仿真平台为一台装有机器人操作系统(ROS)的PC电脑,该电脑系统是Ubuntu14.04,其中数据可视化平台RVIZ是ROS中一款可视化仿真软件。
如图1所示,考虑一台移动机器人,装备有四个麦克纳姆轮,轮子沿着机器人平台的两侧成对安装,并且相对于其质心是均匀的。因此麦克纳姆轮小车可以实现在平面上以三个自由度运动,即沿x、y轴平移和围绕z轴旋转。FM-OMR的物理参数如图9所示。
如图2所示,定义了两个小车的坐标系以及参数。可以根据已知参数代入已建立的运动学模型中。
如图3所示,为了验证所提出的跟踪误差模型适用于各种类型的FM-OMR。使用两个具有不同参数的FM-OMR进行轨迹跟踪控制。Rr是领导者FM-OMR,其轨迹随时间变化。R是跟随者FM-OMR,跟随Rr的轨迹行走。R的参数与图9中的参数相同。因此,R的运动学模型也类似可以用上述式子描述。Rr的主要物理参数如图10所示。其他参数设置与R类似,其中约束等式也适用于Rr,有如下等式:ω1r+ω2r=ω3r+ω4r。
在两个速度约束的FM-OMR运动学模型基础上建立跟踪误差运动学模型。控制输入[u1,u2,u3],使得误差状态量[xe,ye,θe]可以收敛到原点。
基于约束条件下代价函数的EMPC可以通过解以下约束来对问题进行优化:
这取决于:
其中,我们取:
在其实时形式中,EMPC的优化问题可以使用滚动时域的方法解决。在此方法中,仅将给定输入序列的前三维元素视为系统的输入,丢弃所有其他元素。然后,在下一个时间段里,对于新的输出重复这个过程。
如图4至图7所示,仿真中控制器参数定义为:Nc=2,Np=3,Q=400I,P=200I。跟随者小车R的参数为Rw=0.08m,l1=0.32m,l2=0.30m。领导者小车Rr的参数为Rwr=0.05m,l3=0.22m,l4=0.20m。具体的参数解释如图9,图10所示。图4、图5分别表示曲线轨迹追踪实验、相关的跟踪误差;图6、图7表示四个轮子的角速度和跟随者小车R的四个麦克纳姆轮之间的矢量约束。图4的仿真实验中使用所提出的EMPC控制方法跟踪曲线参考轨迹。领导者小车生成参考轨迹的参数定义为:
如图8所示,在机器人操作系统(ROS)中通过RVIZ软件上的仿真实验验证了本发明所提出的基于轨迹跟踪误差全向移动机器人运动学建模的误差模型预测控制方法。
本发明的上述实施例仅仅是为清楚地说明本发明所作的举例,而并非是对本发明的实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明权利要求的保护范围之内。
Claims (7)
1.基于全向移动机器人运动学建模的误差模型预测控制方法,其特征在于,所述方法包括以下步骤:
S11、建立FM-OMR四个麦克纳姆轮之间的速度约束运动学模型;
S12、建立FM-OMR的跟踪误差运动学模型;
S13、针对FM-OMR的轨迹跟踪问题,针对跟踪误差运动学模型,设计结合速度约束方程的误差模型预测控制器;
S14、根据设计的误差模型预测控制器控制全向移动机器人之间的有效轨迹跟踪参数,使全向移动机器人之间的跟踪误差维持不变。
2.根据权利要求1所述的基于全向移动机器人运动学建模的误差模型预测控制方法,其特征在于,S11步骤所述的FM-OMR四个麦克纳姆轮之间的速度约束运动学模型构建包括:
S111、首先对FM-OMR的结构进行描述;
S112、其次对FM-OMR的速度约束进行描述:
将车轮的转速表示为车轮的平移速度表示为而Vir,i=1,2,3,4,是自由移动辊的切向速度,类似地,我们可以将机器人框架中轮子的合成速度表示为:
V1x=V1m+V1rcosα1V1y=V1rsinα1
V2x=V2m+V2rcosα2V2y=V2rsinα2
V3x=V3m+V3rcosα3V3y=V3rsinα3
V4x=V4m+V4rcosα4 V4y=V4rsinα4
其中α1=α3=45,α2=α4=-45,此外,由于轮速与机器人本体的速度是刚性连接的,因此四个轮子速度V1x、V2x、V3x、V4x与机器人本体的速度相关,因此,这种相关性可以建立为:
V1x=vx-l1w V1y=vy+l2w
V2x=vx+l1w V2y=vy+l2w
V3x=vx-l1w V3y=vy-l2w
V4x=vx+l1w V4y=vy-l2w
因此,可以获得FM-OMR机体的速度以及四个轮子的角速度的关系如下:
其中vx、vy是机体沿着x、y方向的速度,ω是机体沿着z方向的角速度。其中R是如下雅可比矩阵:
其中矩阵R不是方阵,因此没有逆矩阵,然而,广义逆矩阵可以表示为:
因此可以得到:
因此,由上面获得:
同样的,可以从上式得到以下等式:
ω1+ω2=ω3+ω4
调整四个麦克纳姆轮各自的速度,可以实现在给定的平面内期望的全向运动,因此,每个轮子的约束产生作用于整个机体,四个麦克纳姆轮之间的速度约束关系由ω1+ω2=ω3+ω4表示,车身速度与四个轮子角速度之间的关系已经得出,机器人本体的速度可以表示如下:
其中,
S113、最后构建FM-OMR的运动学模型:
从上述式子,可以得出非完整FM-OMR的运动学模型如下:
3.根据权利要求书1所述的基于全向移动机器人运动学建模的误差模型预测控制方法,其特征在于,S12步骤所述的FM-OMR跟踪误差运动学建模具体过程为:
S121、确定领导者Rr以及跟随者R的物理参数,其中对于领导者小车,有:
S122、根据领导者以及跟随者在世界坐标系下的位置和角度计算Rr在R坐标系下的相对位置和角度(xe,ye,θe):
其中,(x,y,θ)以及(xr,yr,θr)是分别都是对应于R和Rr的惯性协同坐标系;
S123、根据所得的(xe,ye,θe)计算其导数,建立其导数与输入[u1,u2,u3]之间的状态方程,所述导数表示为:
其中,
a=w1r+w2r+w3r+w4r
b=w1r-w2r-w3r+w4r
c=w1+w2+w3+w4
d=w1-w2-w3+w4
其中,a、b是Rr四个车轮角速度的线性组合,c、d是R四个车轮角速度的线性组合;
则综上四个麦克纳姆轮之间具有速度约束的轨迹跟踪误差运动学模型为:
其中,
u3=wr-w;
S124、通过控制输入[u1,u2,u3],误差状态量[xe,ye,θe]可以收敛到原点。
4.根据权利要求书1所述的基于全向移动机器人运动学建模的误差模型预测控制方法,其特征在于,步骤S13中,设计结合速度约束方程的误差模型预测控制器时,连续时变系统用离散时间模型的形式重新表示,每个特征点的离散时间状态空间模型可以表示为:
ze(k+1)=L(k)ze(k)+M(k)u(k)
其中,表示输入向量,表示状态量, 参数n和m表示状态和输入变量的数量;根据采样定理,给定连续时间系统可以用采样周期T离散化,因此,上式可以写成如下形式:
所述状态空间模型中,为了导出给定预测层Np的最优控制序列,损失函数可以表示为:
其中,Δu(k)表示输入向量的增量,有Δu(k)=u(k)-u(k-1),ze(k+j|k)和△u(k+j|k)表示基于当前时间k,在时间k+j,上的预测变量,此外,Nc代表控制层,Np代表预测层,最后,Q和P表示适当的加权矩阵,T为采样周期;
从以上式子,可以得出:
定义了如下形式的预测向量:
其中,Np=3,Nc=2,且对于所有k≥0时刻,约束表示如下:
其中状态量ze的最大值和最小值输入向量的最大值和最小值输入向量的增量Δu(k)的最小值和最大值均为某一给定的常数;
预测状态可以表示为如下形式:
最终,基于约束条件下代价函数的EMPC算法可通过解以下约束来对问题进行优化:
这取决于:
5.根据权利要求书1所述的基于全向移动机器人运动学建模的误差模型预测控制方法,其特征在于,S13步骤所述的误差模型预测控制器中实时的EMPC算法通过以下步骤实现:
S131、选择适当的控制器参数,包括Nc,Np,Q,P,T以及T1,其中,Nc代表控制层参数,Np代表预测层参数;Q,P表示适当的加权矩阵;T为采样周期,T1为控制周期。
S132、解优化问题得到输入增量:
S133、计算得到k时刻时的输入向量;
S134、将计算的u(k)输入到系统中,更新状态向量以及ze的信息;
S135、根据u(k)解出四个电机的角速度[w1,w2,w3,w4];
S136、如果则k=k+1,重新回到步骤S132,否则退出。
6.根据权利要求书1所述的基于全向移动机器人运动学建模的误差模型预测控制方法,其特征在于,所述误差模型预测控制器采用机器人操作系统ROS的仿真平台进行仿真验证。
7.根据权利要求书5所述的基于全向移动机器人运动学建模的误差模型预测控制方法,其特征在于,所述仿真平台为一台装有机器人操作系统(ROS)的PC电脑,该电脑系统是Ubuntu 14.04,其中数据可视化平台RVIZ是ROS中一款可视化仿真软件。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910142417.4A CN109885052B (zh) | 2019-02-26 | 2019-02-26 | 基于全向移动机器人运动学建模的误差模型预测控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910142417.4A CN109885052B (zh) | 2019-02-26 | 2019-02-26 | 基于全向移动机器人运动学建模的误差模型预测控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109885052A true CN109885052A (zh) | 2019-06-14 |
CN109885052B CN109885052B (zh) | 2022-03-25 |
Family
ID=66929524
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910142417.4A Active CN109885052B (zh) | 2019-02-26 | 2019-02-26 | 基于全向移动机器人运动学建模的误差模型预测控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109885052B (zh) |
Cited By (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110262240A (zh) * | 2019-06-27 | 2019-09-20 | 哈尔滨工业大学 | 分体式制导的导引律设计方法 |
CN110348140A (zh) * | 2019-07-15 | 2019-10-18 | 清华大学 | 基于拖曳距的双轮机器人建模与静止平衡方法及装置 |
CN110525517A (zh) * | 2019-08-27 | 2019-12-03 | 共享智能铸造产业创新中心有限公司 | 全向重载移动机器人的运动控制方法 |
CN111221318A (zh) * | 2019-12-11 | 2020-06-02 | 中山大学 | 一种基于模型预测控制算法的多机器人状态估计方法 |
CN111398984A (zh) * | 2020-03-22 | 2020-07-10 | 华南理工大学 | 基于扫地机器人的自适应激光雷达点云校正与定位方法 |
CN111427350A (zh) * | 2020-03-30 | 2020-07-17 | 江苏大学 | 一种基于麦克纳姆轮的自主移动式增氧机的控制方法 |
CN112025697A (zh) * | 2020-07-10 | 2020-12-04 | 浙江工业大学 | 一种全向移动机器人的积分模型预测控制方法 |
CN112213948A (zh) * | 2020-10-23 | 2021-01-12 | 武汉理工大学 | 一种基于mpc的船舶航速协同控制方法 |
CN112231919A (zh) * | 2020-10-20 | 2021-01-15 | 山东大学 | 一种机器人执行任务过程中的能量消耗预测方法及系统 |
CN112462753A (zh) * | 2020-10-20 | 2021-03-09 | 天津大学 | 车-蛇复合式变结构移动机器人的运动学建模方法 |
CN112632803A (zh) * | 2021-01-12 | 2021-04-09 | 四川大学 | 跟踪控制方法和装置、电子设备及存储介质 |
CN112684793A (zh) * | 2020-12-03 | 2021-04-20 | 南京理工大学 | 一种离散系统中的机器人零半径过弯的轨迹跟踪控制方法 |
CN113359715A (zh) * | 2021-05-26 | 2021-09-07 | 上海大学 | 基于麦克纳姆轮的移动机器人局部轨迹规划方法及系统 |
CN113821891A (zh) * | 2021-09-30 | 2021-12-21 | 上海电机学院 | 一种全向移动机器人动力学模型的建模方法 |
CN114003030A (zh) * | 2021-10-09 | 2022-02-01 | 北京科技大学 | 考虑质心变化的两轮差动移动机器人路径跟踪控制方法 |
CN114019798A (zh) * | 2021-11-03 | 2022-02-08 | 中国科学院深圳先进技术研究院 | 机器人轨迹跟踪控制方法、磁性医疗机器人及存储介质 |
CN114047752A (zh) * | 2021-11-01 | 2022-02-15 | 浙江工业大学 | 基于模糊反演滑模的麦克纳姆轮移动机器人轨迹跟踪控制方法 |
CN114296454A (zh) * | 2021-12-24 | 2022-04-08 | 大连理工大学人工智能大连研究院 | 一种全向全驱移动机器人的自适应运动控制方法及系统 |
CN114371702A (zh) * | 2021-12-17 | 2022-04-19 | 华南理工大学 | 一种应用于视觉伺服的非线性模型预测控制方法 |
DE202022106229U1 (de) | 2022-11-07 | 2022-11-21 | Manas Kumar BERA | Ein System zum Entwurf einer ereignisgesteuerten robusten Steuerung für die Bewegungssteuerung eines mobilen Roboters |
CN115933647A (zh) * | 2022-11-24 | 2023-04-07 | 汕头大学 | 基于复合控制算法的omr轨迹跟踪控制方法及存储介质 |
WO2023103554A1 (zh) * | 2021-12-09 | 2023-06-15 | 灵动科技(北京)有限公司 | 用于移动机器人的轨迹规划方法及计算机程序产品 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106406338A (zh) * | 2016-04-14 | 2017-02-15 | 中山大学 | 一种基于激光测距仪的全向移动机器人的自主导航装置及其方法 |
CN106794576A (zh) * | 2014-04-17 | 2017-05-31 | 软银机器人欧洲公司 | 基于线性预测位置和速度控制器的全向轮式类人机器人 |
CN108454623A (zh) * | 2018-01-22 | 2018-08-28 | 大连理工大学 | 一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制方法 |
JP2019008531A (ja) * | 2017-06-23 | 2019-01-17 | 株式会社豊田自動織機 | 移動車両 |
-
2019
- 2019-02-26 CN CN201910142417.4A patent/CN109885052B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106794576A (zh) * | 2014-04-17 | 2017-05-31 | 软银机器人欧洲公司 | 基于线性预测位置和速度控制器的全向轮式类人机器人 |
CN106406338A (zh) * | 2016-04-14 | 2017-02-15 | 中山大学 | 一种基于激光测距仪的全向移动机器人的自主导航装置及其方法 |
JP2019008531A (ja) * | 2017-06-23 | 2019-01-17 | 株式会社豊田自動織機 | 移動車両 |
CN108454623A (zh) * | 2018-01-22 | 2018-08-28 | 大连理工大学 | 一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制方法 |
Non-Patent Citations (4)
Title |
---|
J´ULIO C´ESAR LINS BARRETO S等: "Design and Implementation of Model-Predictive Control With Friction Compensation on an Omnidirectional Mobile Robot", 《IEEE/ASME TRANSACTIONS ON MECHATRONICS》 * |
曾志文等: "基于模型预测控制的移动机器人轨迹跟踪", 《控制工程》 * |
杨源鑫: "轮式全向移动物流平台的运动学建模与轨迹跟踪控制", 《中国学术期刊(光盘版)电子杂志社》 * |
王昕: "基于模型预测控制的移动机器人轨迹跟踪", 《电脑知识与技术》 * |
Cited By (34)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110262240A (zh) * | 2019-06-27 | 2019-09-20 | 哈尔滨工业大学 | 分体式制导的导引律设计方法 |
CN110262240B (zh) * | 2019-06-27 | 2022-06-21 | 哈尔滨工业大学 | 分体式制导的导引律设计方法 |
CN110348140A (zh) * | 2019-07-15 | 2019-10-18 | 清华大学 | 基于拖曳距的双轮机器人建模与静止平衡方法及装置 |
CN110525517A (zh) * | 2019-08-27 | 2019-12-03 | 共享智能铸造产业创新中心有限公司 | 全向重载移动机器人的运动控制方法 |
CN111221318A (zh) * | 2019-12-11 | 2020-06-02 | 中山大学 | 一种基于模型预测控制算法的多机器人状态估计方法 |
CN111221318B (zh) * | 2019-12-11 | 2023-03-28 | 中山大学 | 一种基于模型预测控制算法的多机器人状态估计方法 |
CN111398984B (zh) * | 2020-03-22 | 2022-03-29 | 华南理工大学 | 基于扫地机器人的自适应激光雷达点云校正与定位方法 |
CN111398984A (zh) * | 2020-03-22 | 2020-07-10 | 华南理工大学 | 基于扫地机器人的自适应激光雷达点云校正与定位方法 |
CN111427350A (zh) * | 2020-03-30 | 2020-07-17 | 江苏大学 | 一种基于麦克纳姆轮的自主移动式增氧机的控制方法 |
CN112025697A (zh) * | 2020-07-10 | 2020-12-04 | 浙江工业大学 | 一种全向移动机器人的积分模型预测控制方法 |
CN112025697B (zh) * | 2020-07-10 | 2022-06-17 | 浙江工业大学 | 一种全向移动机器人的积分模型预测控制方法 |
CN112231919A (zh) * | 2020-10-20 | 2021-01-15 | 山东大学 | 一种机器人执行任务过程中的能量消耗预测方法及系统 |
CN112462753B (zh) * | 2020-10-20 | 2024-01-30 | 天津大学 | 车-蛇复合式变结构移动机器人的运动学建模方法 |
CN112462753A (zh) * | 2020-10-20 | 2021-03-09 | 天津大学 | 车-蛇复合式变结构移动机器人的运动学建模方法 |
CN112213948B (zh) * | 2020-10-23 | 2022-06-10 | 武汉理工大学 | 一种基于mpc的船舶航速协同控制方法 |
CN112213948A (zh) * | 2020-10-23 | 2021-01-12 | 武汉理工大学 | 一种基于mpc的船舶航速协同控制方法 |
CN112684793A (zh) * | 2020-12-03 | 2021-04-20 | 南京理工大学 | 一种离散系统中的机器人零半径过弯的轨迹跟踪控制方法 |
CN112632803A (zh) * | 2021-01-12 | 2021-04-09 | 四川大学 | 跟踪控制方法和装置、电子设备及存储介质 |
CN113359715A (zh) * | 2021-05-26 | 2021-09-07 | 上海大学 | 基于麦克纳姆轮的移动机器人局部轨迹规划方法及系统 |
CN113821891A (zh) * | 2021-09-30 | 2021-12-21 | 上海电机学院 | 一种全向移动机器人动力学模型的建模方法 |
CN113821891B (zh) * | 2021-09-30 | 2023-10-13 | 上海电机学院 | 一种全向移动机器人动力学模型的建模方法 |
CN114003030B (zh) * | 2021-10-09 | 2023-08-08 | 北京科技大学 | 考虑质心变化的两轮差动移动机器人路径跟踪控制方法 |
CN114003030A (zh) * | 2021-10-09 | 2022-02-01 | 北京科技大学 | 考虑质心变化的两轮差动移动机器人路径跟踪控制方法 |
CN114047752A (zh) * | 2021-11-01 | 2022-02-15 | 浙江工业大学 | 基于模糊反演滑模的麦克纳姆轮移动机器人轨迹跟踪控制方法 |
CN114019798B (zh) * | 2021-11-03 | 2023-08-11 | 中国科学院深圳先进技术研究院 | 机器人轨迹跟踪控制方法、磁性医疗机器人及存储介质 |
CN114019798A (zh) * | 2021-11-03 | 2022-02-08 | 中国科学院深圳先进技术研究院 | 机器人轨迹跟踪控制方法、磁性医疗机器人及存储介质 |
WO2023103554A1 (zh) * | 2021-12-09 | 2023-06-15 | 灵动科技(北京)有限公司 | 用于移动机器人的轨迹规划方法及计算机程序产品 |
CN114371702A (zh) * | 2021-12-17 | 2022-04-19 | 华南理工大学 | 一种应用于视觉伺服的非线性模型预测控制方法 |
CN114371702B (zh) * | 2021-12-17 | 2023-11-10 | 华南理工大学 | 一种应用于视觉伺服的非线性模型预测控制方法 |
CN114296454B (zh) * | 2021-12-24 | 2024-05-28 | 大连理工大学人工智能大连研究院 | 一种全向全驱移动机器人的自适应运动控制方法及系统 |
CN114296454A (zh) * | 2021-12-24 | 2022-04-08 | 大连理工大学人工智能大连研究院 | 一种全向全驱移动机器人的自适应运动控制方法及系统 |
DE202022106229U1 (de) | 2022-11-07 | 2022-11-21 | Manas Kumar BERA | Ein System zum Entwurf einer ereignisgesteuerten robusten Steuerung für die Bewegungssteuerung eines mobilen Roboters |
CN115933647A (zh) * | 2022-11-24 | 2023-04-07 | 汕头大学 | 基于复合控制算法的omr轨迹跟踪控制方法及存储介质 |
CN115933647B (zh) * | 2022-11-24 | 2023-09-01 | 汕头大学 | 基于复合控制算法的omr轨迹跟踪控制方法及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN109885052B (zh) | 2022-03-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109885052A (zh) | 基于全向移动机器人运动学建模的误差模型预测控制方法 | |
CN106125728B (zh) | 一种四驱轮式移动机器人轨迹跟踪控制方法 | |
Hashemi et al. | Model-based PI–fuzzy control of four-wheeled omni-directional mobile robots | |
CN103121451B (zh) | 一种弯路换道轨迹的跟踪控制方法 | |
CN105786024B (zh) | 一种基于模型误差补偿的机载光电平台高精度跟踪控制器及其跟踪控制方法 | |
CN101436073A (zh) | 基于量子行为粒子群算法的轮式移动机器人轨迹跟踪方法 | |
CN107168369B (zh) | 一种欠驱动无人车的编队控制方法及系统 | |
Dian et al. | Modeling and trajectory tracking control for magnetic wheeled mobile robots based on improved dual-heuristic dynamic programming | |
CN109857100B (zh) | 一种基于反演法和快速终端滑模的复合轨迹跟踪控制算法 | |
CN108227491A (zh) | 一种基于滑模神经网络的智能车轨迹跟踪控制方法 | |
CN108459605B (zh) | 基于agv系统的轨迹跟踪控制方法 | |
Wang et al. | Attitude and Altitude Controller Design for Quad‐Rotor Type MAVs | |
CN115202349A (zh) | 基于通信干扰的多移动机器人协同编队控制方法、装置、设备及存储介质 | |
CN114510063A (zh) | 一种无人履带车辆及其轨迹跟踪控制方法和系统 | |
Inal et al. | A 3D dynamic model of a spherical wheeled self-balancing robot | |
CN107085432B (zh) | 一种移动机器人的目标轨迹跟踪方法 | |
Khosravian et al. | Design of an intelligent controller for station keeping, attitude control, and path tracking of a quadrotor using recursive neural networks | |
Lai et al. | Image dynamics-based visual servo control for unmanned aerial manipulatorl with a virtual camera | |
Han et al. | Robust optimal control of omni-directional mobile robot using model predictive control method | |
Zhan et al. | Near-optimal trajectory planning of a spherical mobile robot for environment exploration | |
CN102608997A (zh) | 一种基于人工场的轨迹跟踪控制方法 | |
Gong et al. | Backstepping sliding mode tracking control of quad‐rotor under input saturation | |
CN113848905A (zh) | 基于神经网络和自适应控制的移动机器人轨迹跟踪方法 | |
Elsayed et al. | Real time trajectory tracking controller based on lyapunov function for mobile robot | |
CN115343949A (zh) | 一种固定翼无人机跟踪制导律设计方法及验证平台 |
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 |