CN114003030A - 考虑质心变化的两轮差动移动机器人路径跟踪控制方法 - Google Patents
考虑质心变化的两轮差动移动机器人路径跟踪控制方法 Download PDFInfo
- Publication number
- CN114003030A CN114003030A CN202111178307.7A CN202111178307A CN114003030A CN 114003030 A CN114003030 A CN 114003030A CN 202111178307 A CN202111178307 A CN 202111178307A CN 114003030 A CN114003030 A CN 114003030A
- Authority
- CN
- China
- Prior art keywords
- mobile robot
- tracking control
- centroid
- robot
- wheeled
- 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
- 238000000034 method Methods 0.000 title claims abstract description 64
- 230000008859 change Effects 0.000 title claims abstract description 32
- 238000005457 optimization Methods 0.000 claims abstract description 37
- 230000001133 acceleration Effects 0.000 claims description 9
- 238000005303 weighing Methods 0.000 claims description 4
- 238000013178 mathematical model Methods 0.000 claims description 3
- 230000009467 reduction Effects 0.000 abstract description 2
- 230000006870 function Effects 0.000 description 30
- 238000010586 diagram Methods 0.000 description 10
- 230000015654 memory Effects 0.000 description 8
- 230000008569 process Effects 0.000 description 8
- 238000004590 computer program Methods 0.000 description 7
- 238000003860 storage Methods 0.000 description 5
- 238000004458 analytical method Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 101150036841 minJ gene Proteins 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 239000000758 substrate Substances 0.000 description 1
Images
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/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- 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/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
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
本发明公开了一种考虑质心变化的两轮差动移动机器人路径跟踪控制方法,包括:将待控制的两轮差动移动机器人的质心位置参数化并基于参数化的质心位置建立考虑质心变化的两轮差动移动机器人动力学模型;基于动力学模型建立离散化的预测模型并设计优化目标函数;基于优化目标函数确定待控制的两轮差动移动机器人的实际控制输入,实现考虑质心变化的两轮差动移动机器人路径跟踪控制。本发明可以将侧滑纳入考虑,避免两轮差动移动机器人在以较高速度转向时路径跟踪控制的精确性下降,同时解决现有技术在两轮差动移动机器人质心变化时路径跟踪控制无解的问题。
Description
技术领域
本发明涉及移动机器人自主行驶控制技术领域,特别涉及一种考虑质心变化的两轮差动移动机器人路径跟踪控制方法。
背景技术
两轮差动移动机器人是一种常用于物流、仓储等行业的运输设备,其形式结构是机器人前后端安装两个随动万向轮,中部左右侧各安装一个独立驱动的驱动轮。两轮差动移动机器人自主运行的关键技术中包括路径跟踪控制,其功能是控制机器人沿着给定参考路径行驶,控制目标是使机器人与参考路径之间的横向偏差和航向偏差达到最小。
目前常见的两轮差动移动机器人路径跟踪控制方法是无模型路径跟踪控制方法或基于运动学模型的路径跟踪控制方法。无模型路径跟踪控制方法的技术特征包括:不建立两轮差动移动机器人数学模型,直接以两轮差动移动机器人与参考路径之间的横向误差、航向误差等信号为基础设计路径跟踪控制律。基于运动学模型的路径跟踪控制的技术特征包括:首先假设两轮差动移动机器人符合非完整约束条件,即假设两轮差动移动机器人在运行时不发生侧滑,接着在前述假设条件下建立两轮差动移动机器人运动学模型,然后在该模型的基础上设计路径跟踪控制律。前述两种路径跟踪控制方法无法将侧滑纳入考虑,因此在两轮差动移动机器人以较高行驶速度转向时,路径跟踪控制的精确性、安全性无法得到保障。
将侧滑纳入考虑的两轮差动移动机器人路径跟踪控制方法也有两种,一种是通过调节纵向速度避免侧滑的路径跟踪控制方法,另一种是基于动力学模型的路径跟踪控制方法。通过调节纵向速度避免侧滑的路径跟踪控制方法的技术特征包括:采用无模型路径跟踪控制方法或基于运动学模型的路径跟踪控制方法为基础,增加速度调节模块,以实现在转向时降低行驶速度,从而避免侧滑的目的。这种控制方法无法将质心变化纳入考虑,因此速度调节通常趋于保守,两轮差动移动机器人在转向时的行驶速度过低。基于动力学模型的路径跟踪控制方法的技术特征包括:以动力学模型为设计基础,控制目标中包含侧向加速度等动力学因素。提出该方法的文献(Bai G,Liu L,Meng Y,et al.Path tracking ofwheeled mobile robots based on dynamic prediction model[J].IEEE Access,2019,7:39690-39701.)假设质心位于驱动轮所在轴线的中点,未解决质心变化带来的路径跟踪控制无解等问题。
发明内容
本发明提供一种考虑质心变化的两轮差动移动机器人路径跟踪控制方法,以解决现有路径跟踪控制方法无法解决侧滑导致的路径跟踪控制精确性、安全性下降或无法解决质心变化导致的行驶速度过低或路径跟踪控制无解的技术问题。
为解决上述技术问题,本发明提供了如下技术方案:
一方面,本发明提供了一种考虑质心变化的两轮差动移动机器人路径跟踪控制方法,该考虑质心变化的两轮差动移动机器人路径跟踪控制方法包括:
将待控制的两轮差动移动机器人的质心位置参数化,并基于参数化的质心位置,建立考虑质心变化的两轮差动移动机器人动力学模型;
基于所述动力学模型,建立离散化的预测模型并设计优化目标函数;
基于所述优化目标函数,确定待控制的两轮差动移动机器人的实际控制输入,以实现考虑质心变化的两轮差动移动机器人路径跟踪控制。
进一步地,所述基于参数化的质心位置,建立考虑质心变化的两轮差动移动机器人动力学模型,包括:
以机器人驱动轮所在轴线的中点为原点,驱动轮所在轴线为y轴,机器人左侧为y轴正方向,以机器人前后向中轴线为x轴,机器人前方为x轴正方向,建立固结于两轮差动移动机器人的坐标系;
假设两轮差动移动机器人装载货物后的整体质心在所述坐标系中的x坐标为lx,y坐标为ly,建立如下数学模型:
其中,vx为质心处的纵向速度,vy为质心处的横向速度,ω为质心处的横摆角速度,Fxl为左侧驱动轮的驱动力,Fxr为右侧驱动轮的驱动力,Fyl为左侧驱动轮的横向力,Fyr为左侧驱动轮的横向力,m为移动机器人质量,lw为移动机器人宽度,Iz为移动机器人绕垂直方向的转动惯量;分别表示vx、vy、ω的微分变量,即纵向加速度、横向加速度、横摆角加速度;
根据刚体运动学,可得左侧驱动轮的纵向速度vxl为:
vxl=vx-ω(lw/2-ly)
左侧驱动轮的横向速度vyl为:
vyl=vy-ωlx
右侧驱动轮的纵向速度vxr为:
vxr=vx+ω(lw/2+ly)
右侧驱动轮的横向速度vyr为:
vyr=vy-ωlx
将机器人驱动轮所在轴线的中点在大地坐标系下的运动学状态表示为:
根据侧偏角计算公式,可得左右侧驱动力的侧偏角αl和αr:
根据关于横向力的魔术公式fMF()可知,左右侧横向力为:
联立上述所有公式,建立以左右侧驱动轮的驱动力为输入的两轮差动移动机器人动力学模型:
并将所述动力学模型抽象为:
其中:
进一步地,lx与ly是每次装载时通过称重***测量的变量。
进一步地,基于所述动力学模型建立离散化的预测模型,包括:
基于欧拉法离散化所述动力学模型,建立离散化的预测模型。
进一步地,所述设计优化目标函数,包括:
基于迭代预测获得的状态量设计优化目标函数。
进一步地,基于欧拉法离散化动力学模型建立离散化的预测模型,包括:
基于欧拉法离散化所述动力学模型,并写为非线性迭代的形式:
x(1|t)=x(0|t)+Tf(x(0|t),u(1|t))
x(i|t)=x(i-1|t)+Tf(x(i-1|t),u(i|t))
x(Nc|t)=x(Nc-1|t)+Tf(x(Nc-1|t),u(Nc|t))
x(Np|t)=x(Np-1|t)+Tf(x(Np-1|t),u(Nc|t))
其中,x(i|t)表示t时刻的第i个预测状态,u(i|t)表示t时刻的第i个预测输入,T表示迭代周期,Nc表示控制步数,Np表示预测步数。
进一步地,基于迭代预测获得的状态量设计优化目标函数,包括:
获得每步迭代对应的模型输出:
将速度调节控制器的优化目标函数中关于X,Y和θ的误差的惩罚项设计为:
其中,下标ref表示参考值,Q1、Q2、Q3表示权重系数;X(i|t)、Y(i|t)、θ(i|t)分别表示t时刻预测模型输出的第i个横坐标、纵坐标和航向角;Xref(i|t)、Yref(i|t)、θref(i|t)分别表示t时刻的第i个横坐标参考值、纵坐标参考值和航向角参考值;
针对αl和αr,设计如下分段函数:
其中,αmax表示轮胎处于线性范围的最大侧偏角,αel(i|t)和αer(i|t)分别表示t时刻的第i个左、右侧驱动轮侧偏角优化目标值;αl(i|t)、αr(i|t)分别表示t时刻预测模型输出的第i个左、右侧驱动轮侧偏角;
将关于侧滑的优化目标函数设计为:
其中,R为权重系数;
得到两轮差动移动机器人路径跟踪控制最终的优化目标函数为:
J=J1+J2
其中,J表示两轮差动移动机器人路径跟踪控制最终的优化目标函数。
进一步地,基于所述优化目标函数,确定待控制的两轮差动移动机器人的实际控制输入,以实现考虑质心变化的两轮差动移动机器人路径跟踪控制,包括:
求解所述优化目标函数的最小值并将求解得到的第一组控制变量作为实际控制输入,以实现考虑质心变化的两轮差动移动机器人路径跟踪控制。
再一方面,本发明还提供了一种电子设备,其包括处理器和存储器;其中,存储器中存储有至少一条指令,所述指令由处理器加载并执行以实现上述方法。
又一方面,本发明还提供了一种计算机可读存储介质,所述存储介质中存储有至少一条指令,所述指令由处理器加载并执行以实现上述方法。
本发明提供的技术方案带来的有益效果至少包括:
本发明的考虑质心变化的两轮差动移动机器人路径跟踪控制方法首先基于参数化的质心位置建立两轮差动移动机器人动力学模型,然后基于动力学模型建立离散化的预测模型并设计优化目标函数,从而实现考虑质心变化的两轮差动移动机器人路径跟踪控制。本发明可以将侧滑纳入考虑,避免两轮差动移动机器人在以较高速度转向时路径跟踪控制的精确性下降,同时解决现有技术在两轮差动移动机器人质心变化时路径跟踪控制无解的问题。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明实施例提供的考虑质心变化的两轮差动移动机器人路径跟踪控制方法的流程示意图;
图2是本发明实施例提供的两轮差动移动机器人及其质心的示意图;
图3是本发明实施例提供的两轮差动移动机器人在全局坐标系中的运动关系的示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明实施方式作进一步地详细描述。
第一实施例
针对现有技术方案中两轮差动移动机器人在路径跟踪控制过程中侧滑、路径跟踪控制在质心变化时无解等问题,本实施例提供了一种将质心变化纳入考虑的两轮差动移动机器人路径跟踪控制方法,该方法可以由电子设备实现。该方法的执行流程如图1所示,包括以下步骤:
S1,将待控制的两轮差动移动机器人的质心位置参数化,并基于参数化的质心位置,建立考虑质心变化的两轮差动移动机器人动力学模型;
S2,基于所述动力学模型,建立离散化的预测模型并设计优化目标函数;
S3,基于所述优化目标函数确定待控制的两轮差动移动机器人的实际控制输入,以实现考虑质心变化的两轮差动移动机器人路径跟踪控制。
具体地,在本实施例中,上述S1的实现过程如下:
首先,需要说明的是,假设两轮差动移动机器人符合非完整约束条件,是忽略了两轮差动移动机器人在以较高速度转向时路径跟踪控制会出现侧滑这一现象,假设质心位置不变,是忽略了质心变化会导致两轮差动移动机器人路径跟踪控制无解这一现象。下文建立基于参数化的质心位置建立两轮差动移动机器人动力学模型的目的是考虑上述现象,更加接近两轮差动移动机器人路径跟踪控制的真实情况。基于此,S1的实现过程如下:
首先建立固结于两轮差动移动机器人的坐标系。
需要说明的是,如图2所示,本实施例的路径跟踪控制实现方法所针对的两轮差动移动机器人的形式结构是机器人前后端安装两个随动万向轮,中部左右侧各安装一个独立驱动的驱动轮。因此,固结于两轮差动移动机器人的坐标系以机器人驱动轮所在轴线的中点为原点,驱动轮所在轴线为y轴,机器人左侧为y轴正方向,以机器人前后向中轴线为x轴,机器人前方为x轴正方向。两轮差动移动机器人装载货物后的整体质心在前述坐标系中的x坐标为lx,y坐标为ly。lx与ly是每次装载时通过称重等***测量的变量,同时两轮差动移动机器人装载货物后的质量m、转动惯量Iz也在每次装载时通过称重等***测量获得。vx为质心处的纵向速度,vy为质心处的横向速度,ω为质心处的横摆角速度,Fxl为左侧驱动轮的驱动力,Fxr为右侧驱动轮的驱动力,Fyl为左侧驱动轮的横向力,Fyr为左侧驱动轮的横向力,lw为移动机器人宽度。
考虑到万向轮受力很小,受力分析时可以将万向轮忽略不计,因此可以针对两轮差动移动机器人进行如图1所示的受力分析,进而可以建立如下动力学模型:
其中,vx为质心处的纵向速度,vy为质心处的横向速度,ω为质心处的横摆角速度,Fxl为左侧驱动轮的驱动力,Fxr为右侧驱动轮的驱动力,Fyl为左侧驱动轮的横向力,Fyr为左侧驱动轮的横向力,m为移动机器人质量,lw为移动机器人宽度,Iz为移动机器人绕垂直方向的转动惯量;分别表示vx、vy、ω的微分变量,即纵向加速度、横向加速度、横摆角加速度;
考虑到通过控制滑移率控制驱动力的方法已经十分成熟,因此本实施例假设驱动力可控,且上述模型直接以左右侧驱动轮的驱动力作为控制输入。
在此基础上,根据刚体运动学,可得左侧驱动轮的纵向速度vxl为:
vxl=vx-ω(lw/2-ly)
左侧驱动轮的横向速度vyl为:
vyl=vy-ωlx
右侧驱动轮的纵向速度vxr为:
vxr=vx+ω(lw/2+ly)
右侧驱动轮的横向速度vyr为:
vyr=vy-ωlx
此外,如图3所示,机器人驱动轮所在轴线的中点在大地坐标系下的运动学状态可以表示为:
根据侧偏角计算公式,可得左右侧驱动力的侧偏角αl和αr:
又根据关于横向力的魔术公式fMF()可知,左右侧横向力为:
联立上述所有公式,即可建立以左右侧驱动轮的驱动力为输入的两轮差动移动机器人动力学模型:
并可以将上述动力学模型抽象为:
其中:
进一步地,在本实施例中,在基于参数化的质心位置建立两轮差动移动机器人动力学模型后,即可开始执行S2~S3,具体过程如下:
基于动力学模型建立离散化的预测模型并设计优化目标函数时,首先基于欧拉法离散化上述动力学模型,并写为非线性迭代的形式:
x(1|t)=x(0|t)+Tf(x(0|t),u(1|t))
x(i|t)=x(i-1|t)+Tf(x(i-1|t),u(i|t))
x(Nc|t)=x(Nc-1|t)+Tf(x(Nc-1|t),u(Nc|t))
x(Np|t)=x(Np-1|t)+Tf(x(Np-1|t),u(Nc|t))
其中,x(i|t)表示t时刻的第i个预测状态,u(i|t)表示t时刻的第i个预测输入,T表示迭代周期,Nc表示控制步数,Np表示预测步数。
进一步地,基于迭代预测获得的状态量设计优化目标函数,包括:
然后可得每步迭代对应的模型输出:
以此为基础,可以将速度调节控制器的优化目标函数中关于X,Y和θ的误差的惩罚项设计为:
其中,下标ref表示参考值,Q1、Q2、Q3表示权重系数;X(i|t)、Y(i|t)、θ(i|t)分别表示t时刻预测模型输出的第i个横坐标、纵坐标和航向角;Xref(i|t)、Yref(i|t)、θref(i|t)分别表示t时刻的第i个横坐标参考值、纵坐标参考值和航向角参考值;
针对αl和αr,考虑到两轮差动移动机器人在侧偏角较小时仍能正常行驶,因此可以设计如下分段函数:
其中,αmax表示轮胎处于线性范围的最大侧偏角,αel(i|t)和αer(i|t)分别表示t时刻的第i个左、右侧驱动轮侧偏角优化目标值;αl(i|t)、αr(i|t)分别表示t时刻预测模型输出的第i个左、右侧驱动轮侧偏角;
以此为基础,关于侧滑的优化目标函数可以设计为:
其中,R为权重系数;
两轮差动移动机器人路径跟踪控制最终的优化目标函数即为:
J=J1+J2
求解优化目标函数最小值minJ并将求解得到的第一组控制变量作为实际控制输入,即可实现考虑质心变化的两轮差动移动机器人路径跟踪控制。
综上,本实施例的考虑质心变化的两轮差动移动机器人路径跟踪控制方法,在将质心位置参数化后,建立考虑质心变化的两轮差动移动机器人动力学模型,在此基础上采用欧拉法建立离散化的预测模型并基于迭代预测获得的状态量设计优化目标函数,最终实现能够考虑质心变化的两轮差动移动机器人路径跟踪控制,解决了现有技术中两轮差动移动机器人在路径跟踪控制过程中侧滑、路径跟踪控制在质心变化时无解等问题。
第二实施例
本实施例提供一种电子设备,其包括处理器和存储器;其中,存储器中存储有至少一条指令,所述指令由处理器加载并执行,以实现第一实施例的方法。
该电子设备可因配置或性能不同而产生比较大的差异,可以包括一个或一个以上处理器(central processing units,CPU)和一个或一个以上的存储器,其中,存储器中存储有至少一条指令,所述指令由处理器加载并执行上述方法。
第三实施例
本实施例提供一种计算机可读存储介质,该存储介质中存储有至少一条指令,所述指令由处理器加载并执行,以实现上述第一实施例的方法。其中,该计算机可读存储介质可以是ROM、随机存取存储器、CD-ROM、磁带、软盘和光数据存储设备等。其内存储的指令可由终端中的处理器加载并执行上述方法。
此外,需要说明的是,本发明可提供为方法、装置或计算机程序产品。因此,本发明实施例可采用完全硬件实施例、完全软件实施例或结合软件和硬件方面的实施例的形式。而且,本发明实施例可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质上实施的计算机程序产品的形式。
本发明实施例是参照根据本发明实施例的方法、终端设备(***)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、嵌入式处理机或其他可编程数据处理终端设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理终端设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理终端设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。这些计算机程序指令也可装载到计算机或其他可编程数据处理终端设备上,使得在计算机或其他可编程终端设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程终端设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
还需要说明的是,在本文中,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者终端设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者终端设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者终端设备中还存在另外的相同要素。
最后需要说明的是,以上所述是本发明优选实施方式,应当指出,尽管已描述了本发明优选实施例,但对于本技术领域的技术人员来说,一旦得知了本发明的基本创造性概念,在不脱离本发明所述原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。所以,所附权利要求意欲解释为包括优选实施例以及落入本发明实施例范围的所有变更和修改。
Claims (8)
1.一种考虑质心变化的两轮差动移动机器人路径跟踪控制方法,其特征在于,所述两轮差动移动机器人路径跟踪控制实现方法包括:
将待控制的两轮差动移动机器人的质心位置参数化,并基于参数化的质心位置,建立考虑质心变化的两轮差动移动机器人动力学模型;
基于所述动力学模型,建立离散化的预测模型并设计优化目标函数;
基于所述优化目标函数,确定待控制的两轮差动移动机器人的实际控制输入,以实现考虑质心变化的两轮差动移动机器人路径跟踪控制。
2.如权利要求1所述的考虑质心变化的两轮差动移动机器人路径跟踪控制方法,其特征在于,所述基于参数化的质心位置,建立考虑质心变化的两轮差动移动机器人动力学模型,包括:
以机器人驱动轮所在轴线的中点为原点,驱动轮所在轴线为y轴,机器人左侧为y轴正方向,以机器人前后向中轴线为x轴,机器人前方为x轴正方向,建立固结于两轮差动移动机器人的坐标系;
假设两轮差动移动机器人装载货物后的整体质心在所述坐标系中的x坐标为lx,y坐标为ly,建立如下数学模型:
其中,vx为质心处的纵向速度,vy为质心处的横向速度,ω为质心处的横摆角速度,Fxl为左侧驱动轮的驱动力,Fxr为右侧驱动轮的驱动力,Fyl为左侧驱动轮的横向力,Fyr为左侧驱动轮的横向力,m为移动机器人质量,lw为移动机器人宽度,Iz为移动机器人绕垂直方向的转动惯量;分别表示vx、vy、ω的微分变量,即纵向加速度、横向加速度、横摆角加速度;
根据刚体运动学,可得左侧驱动轮的纵向速度vxl为:
vxl=vx-ω(lw/2-ly)
左侧驱动轮的横向速度vyl为:
vyl=vy-ωlx
右侧驱动轮的纵向速度vxr为:
vxr=vx+ω(lw/2+ly)
右侧驱动轮的横向速度vyr为:
vyr=vy-ωlx
将机器人驱动轮所在轴线的中点在大地坐标系下的运动学状态表示为:
根据侧偏角计算公式,可得左右侧驱动力的侧偏角αl和αr:
根据关于横向力的魔术公式fMF()可知,左右侧横向力为:
联立上述所有公式,建立以左右侧驱动轮的驱动力为输入的两轮差动移动机器人动力学模型:
并将所述动力学模型抽象为:
其中:
3.如权利要求2所述的考虑质心变化的两轮差动移动机器人路径跟踪控制方法,其特征在于,lx与ly是每次装载时通过称重***测量的变量。
4.如权利要求2或3所述的考虑质心变化的两轮差动移动机器人路径跟踪控制方法,其特征在于,基于所述动力学模型建立离散化的预测模型,包括:
基于欧拉法离散化所述动力学模型,建立离散化的预测模型。
5.如权利要求4所述的考虑质心变化的两轮差动移动机器人路径跟踪控制方法,其特征在于,所述设计优化目标函数,包括:
基于迭代预测获得的状态量设计优化目标函数。
6.如权利要求5所述的考虑质心变化的两轮差动移动机器人路径跟踪控制方法,其特征在于,基于欧拉法离散化所述动力学模型建立离散化的预测模型,包括:
基于欧拉法离散化所述动力学模型,并写为非线性迭代的形式:
x(1|t)=x(0|t)+Tf(x(0|t),u(1|t))
x(i|t)=x(i-1|t)+Tf(x(i-1|t),u(i|t))
x(Nc|t)=x(Nc-1|t)+Tf(x(Nc-1|t),u(Nc|t))
x(Np|t)=x(Np-1|t)+Tf(x(Np-1|t),u(Nc|t))
其中,x(i|t)表示t时刻的第i个预测状态,u(i|t)表示t时刻的第i个预测输入,T表示迭代周期,Nc表示控制步数,Np表示预测步数。
7.如权利要求6所述的考虑质心变化的两轮差动移动机器人路径跟踪控制方法,其特征在于,基于迭代预测获得的状态量设计优化目标函数,包括:
获得每步迭代对应的模型输出:
其中,下标ref表示参考值,Q1、Q2、Q3表示权重系数;X(i|t)、Y(i|t)、θ(i|t)分别表示t时刻预测模型输出的第i个横坐标、纵坐标和航向角;Xref(i|t)、Yref(i|t)、θref(i|t)分别表示t时刻的第i个横坐标参考值、纵坐标参考值和航向角参考值;
针对αl和αr,设计如下分段函数:
其中,αmax表示轮胎处于线性范围的最大侧偏角,αel(i|t)和αer(i|t)分别表示t时刻的第i个左、右侧驱动轮侧偏角优化目标值;αl(i|t)、αr(i|t)分别表示t时刻预测模型输出的第i个左、右侧驱动轮侧偏角;
将关于侧滑的优化目标函数设计为:
其中,R为权重系数;
得到两轮差动移动机器人路径跟踪控制最终的优化目标函数为:
J=J1+J2
其中,J表示两轮差动移动机器人路径跟踪控制最终的优化目标函数。
8.如权利要求7所述的考虑质心变化的两轮差动移动机器人路径跟踪控制方法,其特征在于,基于所述优化目标函数,确定待控制的两轮差动移动机器人的实际控制输入,以实现考虑质心变化的两轮差动移动机器人路径跟踪控制,包括:
求解所述优化目标函数的最小值并将求解得到的第一组控制变量作为实际控制输入,以实现考虑质心变化的两轮差动移动机器人路径跟踪控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111178307.7A CN114003030B (zh) | 2021-10-09 | 2021-10-09 | 考虑质心变化的两轮差动移动机器人路径跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111178307.7A CN114003030B (zh) | 2021-10-09 | 2021-10-09 | 考虑质心变化的两轮差动移动机器人路径跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114003030A true CN114003030A (zh) | 2022-02-01 |
CN114003030B CN114003030B (zh) | 2023-08-08 |
Family
ID=79922445
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111178307.7A Active CN114003030B (zh) | 2021-10-09 | 2021-10-09 | 考虑质心变化的两轮差动移动机器人路径跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114003030B (zh) |
Citations (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20110304633A1 (en) * | 2010-06-09 | 2011-12-15 | Paul Beardsley | display with robotic pixels |
CN108919794A (zh) * | 2018-06-01 | 2018-11-30 | 广州视源电子科技股份有限公司 | 一种双轮差速型移动机器人的全局路径规划方法及其装置 |
CN109795502A (zh) * | 2018-09-27 | 2019-05-24 | 吉林大学 | 智能电动汽车路径跟踪模型预测控制方法 |
CN109857098A (zh) * | 2018-12-11 | 2019-06-07 | 东南大学 | 一种基于mpc的自动驾驶农机轨迹跟踪***及方法 |
CN109885052A (zh) * | 2019-02-26 | 2019-06-14 | 华南理工大学 | 基于全向移动机器人运动学建模的误差模型预测控制方法 |
CN110286683A (zh) * | 2019-07-15 | 2019-09-27 | 北京科技大学 | 一种履带式移动机器人的自主行驶路径跟踪控制方法 |
WO2019228435A1 (zh) * | 2018-06-01 | 2019-12-05 | 浙江亚特电器有限公司 | 用于移动载具的路径跟踪方法 |
CN110539752A (zh) * | 2019-06-26 | 2019-12-06 | 江苏大学 | 一种智能汽车多预测范围模型预测轨迹跟踪控制方法及*** |
CN110696793A (zh) * | 2019-09-19 | 2020-01-17 | 江苏理工学院 | 一种四轮转向联合差动制动的智能车辆分层控制方法 |
CN111522237A (zh) * | 2020-04-24 | 2020-08-11 | 北京科技大学 | 一种半挂车的避障控制方法 |
CN111624992A (zh) * | 2020-04-28 | 2020-09-04 | 北京科技大学 | 一种基于神经网络的搬运机器人的路径跟踪控制方法 |
CN111949036A (zh) * | 2020-08-25 | 2020-11-17 | 重庆邮电大学 | 一种轨迹跟踪控制方法、***及两轮差速移动机器人 |
CN112000095A (zh) * | 2020-07-30 | 2020-11-27 | 北京科技大学 | 一种铲运机工作机构的控制方法 |
CN112230651A (zh) * | 2020-07-06 | 2021-01-15 | 湖南工业大学 | 一种基于分层控制理论的分布式无人车路径跟踪控制方法 |
CN112882474A (zh) * | 2021-01-26 | 2021-06-01 | 北京科技大学 | 基于时变模型预测控制的一体式无人汽车换道控制方法 |
WO2021168669A1 (zh) * | 2020-02-25 | 2021-09-02 | 华为技术有限公司 | 车辆控制方法及装置 |
WO2021179038A1 (en) * | 2020-03-10 | 2021-09-16 | Commonwealth Scientific And Industrial Research Organisation | Modular wheel arrangement |
-
2021
- 2021-10-09 CN CN202111178307.7A patent/CN114003030B/zh active Active
Patent Citations (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20110304633A1 (en) * | 2010-06-09 | 2011-12-15 | Paul Beardsley | display with robotic pixels |
CN108919794A (zh) * | 2018-06-01 | 2018-11-30 | 广州视源电子科技股份有限公司 | 一种双轮差速型移动机器人的全局路径规划方法及其装置 |
WO2019228435A1 (zh) * | 2018-06-01 | 2019-12-05 | 浙江亚特电器有限公司 | 用于移动载具的路径跟踪方法 |
CN109795502A (zh) * | 2018-09-27 | 2019-05-24 | 吉林大学 | 智能电动汽车路径跟踪模型预测控制方法 |
CN109857098A (zh) * | 2018-12-11 | 2019-06-07 | 东南大学 | 一种基于mpc的自动驾驶农机轨迹跟踪***及方法 |
CN109885052A (zh) * | 2019-02-26 | 2019-06-14 | 华南理工大学 | 基于全向移动机器人运动学建模的误差模型预测控制方法 |
CN110539752A (zh) * | 2019-06-26 | 2019-12-06 | 江苏大学 | 一种智能汽车多预测范围模型预测轨迹跟踪控制方法及*** |
CN110286683A (zh) * | 2019-07-15 | 2019-09-27 | 北京科技大学 | 一种履带式移动机器人的自主行驶路径跟踪控制方法 |
CN110696793A (zh) * | 2019-09-19 | 2020-01-17 | 江苏理工学院 | 一种四轮转向联合差动制动的智能车辆分层控制方法 |
WO2021168669A1 (zh) * | 2020-02-25 | 2021-09-02 | 华为技术有限公司 | 车辆控制方法及装置 |
WO2021179038A1 (en) * | 2020-03-10 | 2021-09-16 | Commonwealth Scientific And Industrial Research Organisation | Modular wheel arrangement |
CN111522237A (zh) * | 2020-04-24 | 2020-08-11 | 北京科技大学 | 一种半挂车的避障控制方法 |
CN111624992A (zh) * | 2020-04-28 | 2020-09-04 | 北京科技大学 | 一种基于神经网络的搬运机器人的路径跟踪控制方法 |
CN112230651A (zh) * | 2020-07-06 | 2021-01-15 | 湖南工业大学 | 一种基于分层控制理论的分布式无人车路径跟踪控制方法 |
CN112000095A (zh) * | 2020-07-30 | 2020-11-27 | 北京科技大学 | 一种铲运机工作机构的控制方法 |
CN111949036A (zh) * | 2020-08-25 | 2020-11-17 | 重庆邮电大学 | 一种轨迹跟踪控制方法、***及两轮差速移动机器人 |
CN112882474A (zh) * | 2021-01-26 | 2021-06-01 | 北京科技大学 | 基于时变模型预测控制的一体式无人汽车换道控制方法 |
Non-Patent Citations (7)
Title |
---|
BAI, G., LIU, L., MENG, Y., LUO, W., GU, Q., & WANG, J: "Path tracking of wheeled mobile robots based on dynamic prediction model", 《IEEE ACCESS》, pages 39690 - 39701 * |
BAI, G., MENG, Y., GU, Q., LI, K., & LI, S: "Improvement of vehicle path tracking by relaxing the steering angle speed limit", 《2020 CHINESE AUTOMATION CONGRESS》, pages 6886 - 6889 * |
STEFEK A, VAN PHAM T, KRIVANEK V, ET AL: "Energy comparison of controllers used for a differential drive wheeled mobile robot", 《IEEE ACCESS》, no. 8, pages 1 - 4 * |
孟宇;汪钰;顾青;白国星;: "基于预见位姿信息的铰接式车辆LQR-GA路径跟踪控制", 《农业机械学报》, no. 06, pages 382 - 391 * |
孟宇;甘鑫;白国星;: "基于预瞄距离的地下矿用铰接车路径跟踪预测控制", 《工程科学学报》, no. 05, pages 119 - 128 * |
熊璐等: "无人驾驶车辆的运动控制发展现状综述", 《机械工程学报》, vol. 56, no. 10, pages 127 - 129 * |
白国星: "基于非线性模型预测控制的移动机器人实时路径跟踪", 《农业机械学报》, vol. 51, no. 9, pages 1 - 4 * |
Also Published As
Publication number | Publication date |
---|---|
CN114003030B (zh) | 2023-08-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107415939B (zh) | 一种分布式驱动电动汽车转向稳定性控制方法 | |
CN105320129B (zh) | 一种无人驾驶自行车轨迹跟踪控制的方法 | |
Hu et al. | Robust H∞ output-feedback control for path following of autonomous ground vehicles | |
CN112622903B (zh) | 一种车辆跟随驾驶环境下自主车辆的纵向和横向控制方法 | |
Villagra et al. | Flatness-based vehicle steering control strategy with SDRE feedback gains tuned via a sensitivity approach | |
WO2007105077A2 (en) | Trajectory tracking control system and method for mobile unit | |
Xu et al. | Model predictive control for lane keeping system in autonomous vehicle | |
Chen et al. | Design and experimental evaluation of an efficient MPC-based lateral motion controller considering path preview for autonomous vehicles | |
Kebbati et al. | Lateral control for autonomous wheeled vehicles: A technical review | |
CN110217229A (zh) | 一种适用于高速极限工况的路径跟踪控制方法 | |
CN116560371A (zh) | 基于自适应模型预测控制的自动驾驶车辆路径跟踪方法 | |
CN115583248A (zh) | 控制车辆的运动 | |
Qi et al. | An mpc-based controller framework for agile maneuvering of autonomous vehicles | |
Vörös et al. | Lane keeping control using finite spectrum assignment with modeling errors | |
CN114003030B (zh) | 考虑质心变化的两轮差动移动机器人路径跟踪控制方法 | |
CN114896694B (zh) | 一种基于两点预瞄的路径跟踪控制方法 | |
CN116653988A (zh) | 一种自动驾驶车辆纵向控制方法、***及车辆 | |
CN115817509A (zh) | 一种基于ampc的多轴分布式驱动车辆转向辅助轨迹跟踪方法 | |
Huang et al. | Data-driven shared steering control design for lane keeping | |
Zheng et al. | Model predictive control based vehicle stability control via active front steering | |
Malmir et al. | A model predictive controller for minimum time cornering | |
CN113985868A (zh) | 一种轮式移动机器人分层路径跟踪控制实现方法 | |
Huang et al. | Dynamic model construction and simulation based on intelligent driving vehicle | |
Hakima et al. | Improvement of vehicle handling by an integrated control system of four wheel steering and ESP with fuzzy logic approach | |
Feng et al. | Active Lane‐Changing Control of Intelligent Vehicle on Curved Section of Expressway |
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 |