CN108897224A - 一种不确定轮式移动机器人的自适应轨迹跟踪控制方法 - Google Patents
一种不确定轮式移动机器人的自适应轨迹跟踪控制方法 Download PDFInfo
- Publication number
- CN108897224A CN108897224A CN201810878270.0A CN201810878270A CN108897224A CN 108897224 A CN108897224 A CN 108897224A CN 201810878270 A CN201810878270 A CN 201810878270A CN 108897224 A CN108897224 A CN 108897224A
- Authority
- CN
- China
- Prior art keywords
- robot
- indicate
- parameter
- unit
- mobile robot
- 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
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/0088—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Artificial Intelligence (AREA)
- Health & Medical Sciences (AREA)
- Game Theory and Decision Science (AREA)
- Business, Economics & Management (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Software Systems (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种不确定轮式移动机器人的自适应轨迹跟踪控制方法,包括以下步骤:S1、建立轮式移动机器人的系统模型模块的动力学方程;S2、采用积分反演策略,通过递推Lyapunov函数的方法,针对机器人系统的未知参数,设计基于Lyapunov稳定性理论建立控制输入模块的模型。该发明的优点在于:能较好地补偿系统参数摄动的影响、提高移动机器人的轨迹跟踪性能和鲁棒性。在系统部分参数未知,以及外界扰动的界限也未知的情况下自动调节控制参数,提高控制精度,以保证移动机器人的轨迹跟踪性能和鲁棒性,具有较好的实际应用价值和社会意义。
Description
技术领域
本发明涉及控制电路领域,尤其是一种不确定轮式移动机器人的自适应轨迹跟踪控制方法。
背景技术
轮式移动机器人是一个典型的时延、非线性不稳定系统,其控制问题因其理论挑战性和广泛的实际应用价值而吸引了大批研究者。轮式移动机器人受到纯滚动约束,是典型的非完整系统。其基本运动控制目标可以表述为:1)两个位姿间的移动;2)跟踪一个给定的时间轨迹;3)跟踪一个给定的几何路径。移动机器人的轨迹跟踪控制系统中,由于外界未知干扰的存在以及系统自身的不稳定性缺点,使得轮式移动机器人实际的轨迹与期望轨迹之间总是存在误差的。
为了消除这种误差,各种轨迹跟踪控制技术应运而生。目前,轮式移动机器人轨迹跟踪控制方法大致分为自适应控制,鲁棒控制,神经网络控制,反演控制,滑模控制和模糊控制等。模糊控制(Fuzzy Control)方法克服了传统算法的不足,在移动机器人的轨迹跟踪研究中体现出的控制效果相较于一般控制更优,且具有轨迹跟踪稳定和精度较高的优点。移动机器人是一个典型的时延、非线性不稳定系统,而模糊控制充分发挥其不需要数学模型、运用控制专家的信息及具有鲁棒性的优点而得到广泛的应用。反演控制(BacksteppingControl) 方法是近年来研究非线性系统反馈控制律的热点之一。反演控制方法的基本思想是通过构建Lyapunov函数推导出系统的控制律,采用逆向思维的方法进行设计。基于反演控制技术的移动机器人控制器的设计可以有效地解决不确定性系统的稳定性。自适应控制(Adaptive Control)的研究对象是具有一定程度不确定性的系统,和常规的反馈控制和最优控制一样,也是一种基于数学模型的控制方法,所不同的只是自适应控制所依据的关于模型和扰动的先验知识比较少,需要在系统的运行过程中去不断提取有关模型的信息,使模型逐步完善,这个特点刚好适用于参数不确定轮式移动机器人的轨迹跟踪问题。
现有的学术成果不乏有高级控制策略被设计出来解决参数不确定轮式移动机器人的轨迹跟踪问题,但是还未被开发处较好地补偿系统参数摄动的影响、提高移动机器人的轨迹跟踪性能和鲁棒性的控制方法。
发明内容
为了克服上述现有技术存在的不足,为此,本发明提供一种不确定轮式移动机器人的自适应轨迹跟踪控制方法。
为实现上述目的,本发明采用以下技术方案:
一种不确定轮式移动机器人的自适应轨迹跟踪控制方法,包括以下步骤:
S1、建立轮式移动机器人的系统模型模块的动力学方程;
S2、采用积分反演策略,通过递推Lyapunov函数的方法,针对机器人系统的未知参数,设计基于Lyapunov稳定性理论建立控制输入模块的模型。
具体地说,步骤S1中动力学方程为
其中表示机器人前进加速度,v表示机器人前进速度,表示机器人角速度,表示机器人角加速度,a1、b1、a2、b2表示机器人模型参数,u1和u2机器人控制输入。
具体地说,其中,
c表示轮胎与地面的摩擦系数,M表示机器人总质量,r表示车轮半径,Iw表示驱动轮的转动惯量,L表示机器人宽度的一半,IV表示绕机器人重心的转动惯量,k表示电机及传动机构的驱动增益。
具体地说,步骤S2中模型方程为
r1、r2、d1、d2表示机器人模型参数,ζ、w*表示机器人中间变量,e1表示速度误差,e2表示角度误差,e3表示角速度误差,Ψ为机器人模型变量,为参数自适应律。
具体地说,其中,
速度误差e1、角度误差e2、角速度误差e3由误差获取模块处理获得,具体的, e1=vd-v,e2=φd-φ,e3=ω*-ω,机器人中间变量ζ、w*由中间变量模块处理后获得,机器人中间变量ζ、w*的表达式分别为
其中参数自适应律和参数自适应律通过参数调节模块获得,机器人中间变量Ψ通过中间变量模块获得,参数自适应律和参数自适应律的导数、机器人中间变量Ψ表达式为:
本发明的优点在于:
(1)本方法能较好地补偿系统参数摄动的影响、提高移动机器人的轨迹跟踪性能和鲁棒性,在系统部分参数未知,以及外界扰动的界限也未知的情况下自动调节控制参数,提高控制精度,以保证移动机器人的轨迹跟踪性能和鲁棒性,具有较好的实际应用价值和社会意义。
(2)本专利利用理论分析结果,在控制算法上加以创新和改进,运用自适应技术实时补偿参数摄动的影响,设计一个与之相对的控制电路模块物理实现自适应控制策略,以应用于实际的移动机器人的轨迹跟踪控制系统中。
(3)本发明中方法可以克服外部扰动,稳定性强。
附图说明
图1为电路设计中所需的反相运算放大单元的电路原理图。
图2为电路设计中所需的反相加法运算单元的电路原理图。
图3为电路设计中所需的同相加法运算单元的电路原理图。
图4为电路设计中所需的减法运算放大单元的电路原理图。
图5为电路设计中所需的乘法器的电路原理图。
图6为电路设计中所需的除法运算放大单元的电路原理图。
图7为电路设计中所需的积分运算放大单元的电路原理图。
图8为电路设计中所需的微分运算放大单元的电路原理图。
图9为机器人运动示意图。
图10为参数自适应率电路设计的结构框图。
图11为参数自适应率电路设计的详细电路原理图。
图12为参数自适应率电路设计的结构框图。
图13为中间变量ζ电路设计的结构框图。
图14为中间变量电路设计的结构框图。
图15为中间变量和电路设计的结构框图。
图16为中间变量w*电路设计的结构框图。
图17为中间变量Ψ电路设计的结构框图。
图18为系统误差e1电路设计的结构框图。
图19为控制算法u1电路设计的结构框图。
图20为控制算法u2电路设计的结构框图。
图21为子系统电路设计的结构框图。
图22为子系统φ电路设计的结构框图。
图23为总电路的系统结构框图。
图24为本发明电路在Multisim仿真中的系统误差曲线图。
具体实施方式
在轮式移动机器人系统控制层中,有2个所要控制的状态,分别是机器人前进的速度和机器人的方向角。为了更加详细的说明本专利,我们以两轮独立驱动的移动机器人为例。该移动机器人的两个前轮为独立驱动轮,各采用一台直流伺服电机独立驱动,通过调节各自的输入电压以实现两前轮的速度差,达到调整车体与跟踪轨迹的位置关系。移动机器人的后轮为随动轮,仅起支撑车体的作用,而无导向作用。
系统控制方法,包括以下步骤:
S1、建立轮式移动机器人的系统模型模块的动力学方程,动力学方程为
其中表示机器人前进加速度,v表示机器人前进速度,表示机器人角速度,表示机器人角加速度,a1、b1、a2、b2表示机器人模型参数,u1和u2机器人控制输入;
其中,
c表示轮胎与地面的摩擦系数,M表示机器人总质量,r表示车轮半径,Iw表示驱动轮的转动惯量,L表示机器人宽度的一半,IV表示绕机器人重心的转动惯量,k表示电机及传动机构的驱动增益,机器人运动示意图如图9所示。
S2、采用积分反演策略,通过递推Lyapunov函数的方法,针对机器人系统的未知参数,设计基于Lyapunov稳定性理论建立控制输入模块的模型,模型方程为
r1、r2、d1、d2表示机器人模型参数,ζ、w*表示机器人中间变量,e1表示速度误差,e2表示角度误差,e3表示角速度误差,Ψ为机器人模型变量,为参数自适应律;
其中,
速度误差e1、角度误差e2、角速度误差e3由误差获取模块处理获得,具体的, e1=vd-v,e2=φd-φ,e3=ω*-ω,机器人中间变量ζ、w*由中间变量模块处理后获得,机器人中间变量ζ、w*的表达式分别为
其中参数自适应律和参数自适应律通过参数调节模块获得,机器人中间变量Ψ通过中间变量模块获得,参数自适应律和参数自适应律的导数、机器人中间变量Ψ表达式为:
通过以上的控制器设计,利用Lyapunov稳定性理论可以证明控制器的有效性:
定义Lyapunov函数为
其中
对公式(8)进行求导得将上述所设计的控制器公式(3)-公式(7)代入至式子中,并通过缩放最终可以获得:
其中k1,k2,k3都大于0,即通过Lyapunov稳定性理论可以得知,以上所设计的控制器完全可以使系统稳定,即证明了该控制器的有效性。
根据这些理论的结果,我们可以利用运算放大电路的相关知识设计出相对应的运算电路来实现此类自适应backstepping的算法以应用于具体的工业环境。
在该实施例中,移动机器人模型的物理参数如下表一所示。
名称 | 符号 | 标称值 |
质量 | M | 50kg |
驱动轮半径 | r | 0.125m |
车轮与地面间摩擦系数 | c | 0.05kg·m2/s |
绕机器人重心转动惯量 | IV | 10kg·m2 |
轮子转动惯量 | IW | 0.05kg·m2 |
两驱动轮到机器人重心距离 | L | 0.5m |
电机及传动机构的驱动增益 | k | 20Nm/V |
表一
根据系统模型物理参数知机器人参数的具体对应的值如下表二所示。
表二
经过反复的实验与比较得出控制效果较好的控制参数,如下表三所示。
控制参数 | k0 | k1 | k2 | k3 | λ1 | λ2 |
数值 | 20 | 10.3 | 16 | 14.5 | 1 | 1 |
表三
下面将根据以上的参数与所设计的控制器设计移动机器人的运算电路系统与控制算法。
为实现各模块电路,在该实施例中,针对基础电路即反相运算放大单元、反相加法运算单元、同相加法运算单元、除法运算放大单元、减法运算单元、积分运算放大单元、乘法器单元和微分运算放大单元做如下说明。
反相运算放大单元
如图1所示,反相运算放大单元包括电阻R1、电阻Rf、运算放大器,所述反相运算放大单元的输入端经过电阻R1连接在运算放大器的负输入端,运算放大器的正输入端经过电阻Rc与地连接,所述运算放大器的输出端作为反相运算放大单元的输出端。
电阻R1、电阻Rf为根据比例运算的要求而设定的阻值。应用运算放大器的虚短、虚断的知识可知运放的反相输入端输入电压ui,可以得到输出端电压始终设置R1=10KΩ,这样只要设置Rf的阻值就可以得到相应的比例关系。表四表示各反相运算放大单元中Rf的值对应的输入输出关系。
表四
反相加法运算单元
如图2所示,反相加法运算单元包括r+2个电阻Rc、运算放大器,运算放大器的正极经过其中一个电阻Rc与地连接,另一个电阻Rc连接在运算放大器的负输入端和输出端之间,r个输入端分别经过相应的电阻Rc与运算放大器的负输入端连接,所述运算放大器的输出端作为反相加法运算单元的输出端。r表示输入端个数。
运算放大器的反相输入端接入电压分别为ui1、ui2…uir,则在放大器的输出端可以得到电压uo=-(ui1+ui2+...+uir)。表五表示各反相加法运算单元对应的输入输出关系。
反相加法运算单元 | 输入端个数(个) | 输入输出关系 |
B1 | 3 | uo=-(u1+u2+u3) |
B2 | 3 | uo=-(u1+u2+u3) |
B3 | 2 | uo=-(u1+u2) |
B4 | 3 | uo=-(u1+u2+u3) |
表五
同向加法运算单元
如图3所示,同相加法运算单元包括电阻Rf、r+1个电阻Rc、运算放大器,运算放大器的负输入端经过其中一个电阻Rc与地连接,并接经过电阻Rf与运算放大器的输出端连接,r个输入端分别经过相应的电阻Rc与运算放大器的正输入端连接,即所述运算放大器的输出端可作为同相加法运算单元的输出端。
运算放大器的同相输入端接入电压ui1、ui2…uir,此时设置 Rf=r×10KΩ,则在放大器的输出端可以得到电压uo=ui1+ui2+...+uir。下表表六表示各同相加法运算单元对应的输入输出关系。
同相加法运算单元 | Rf的阻值(kΩ) | 输入输出关系 |
C1 | 20 | uo=ui1+ui2 |
C2 | 20 | uo=ui1+ui2 |
C3 | 30 | uo=ui1+ui2+ui3 |
C4 | 20 | uo=ui1+ui2 |
表六
减法运算单元
如图4所示,减法运算单元包括电阻Rf、3个电阻Rc、运算放大器,运算放大器的负输入端经过其中一个电阻Rc接输入电压ui2,并经过电阻Rf与运算放大器的输出端连接,运算放大器的正输入端经过其中一个电阻Rc接输入电压ui1,同时经过另一个电阻Rc与地连接,则所述运算放大器的输出端可作为减法运算单元的输出端。即在放大器的输出端可以得到电压 uo=ui1-ui2。后面电路图所用的减法运算单元D1、D2、D3均是用上述方法实现的。
乘法器单元
如图5所示,乘法器单元有两个输入端分别接入电压ui1和ui2,且乘法器单元增益为k,则在乘法器单元的输出端可得到电压uo=k×ui1×ui2。下表表七表示各乘法器单元对应的输入输出关系。
表七
除法运算放大单元
如图6所示,除法运算放大单元包括增益为1的乘法器、3个电阻Rc、运算放大器,一个输入端经过第一个电阻Rc与运算放大器的负输入端连接,另一个输入端与乘法器的一个输入端连接,乘法器的另一个输入端与运算放大器的输出端连接,乘法器的输出端经过第二个电阻Rc与运算放大器的负输入端连接,运算放大器的正输入端经过第三个电阻Rc与地连接,所述运算放大器的输出端作为除法运算放大单元的输出端。
在运算放大器的反相输入端接入电压ui1,在乘法器的输入端接入电压 ui2,通过运算放大器的电路知识可以得到放大器的输出电压其中要保证ui2>0,否则不能实现除法运算。后面电路图所用的除法运算放大单元F1、F2、F3均是用上述方法实现的。
积分运算放大单元
如图7所示,积分运算放大单元包括电阻R1、电容Cf、电阻R2、运算放大器,积分运算放大单元的输入端经过电阻R1与运算放大器的负输入端连接,运算放大器的负输入端经过电容Cf与运算放大器的输出端连接,运算放大器的正输入端经过电阻R2与地连接,所述运算放大器的输出端作为积分运算放大单元的输出端。
在输入端接入电压ui,则在积分运算放大单元的输出端可获得电压在设计控制器时通常需要uo=∫uidt,则令R1=100kΩ、Cf=10uF,R2=100kΩ,则uo=-∫uidt。后面电路图所用的积分运算放大单元 G1、G2、G3均是用上述方法实现的。
微分运算放大单元
如图8所示,微分运算放大单元包括电阻R1、电容Cf、电阻R2、运算放大器,积分运算放大单元的输入端经过电容Cf与运算放大器的负输入端连接,运算放大器的负输入端经过电阻R1与运算放大器的输出端连接,运算放大器的正输入端经过电阻R2与地连接,所述运算放大器的输出端作为微分运算放大单元的输出端。
在输入端接入电压ui,则在微分运算放大单元的输出端可获得电压在设计控制器时需要则令R1=100kΩ、Cf=10uF, R2=100kΩ,则后面电路图所用的积分运算放大单元H1、H2、 H3均是用上述方法实现的。
在上述电路设计中的基础电路的说明中,所用到的运算放大器的型号为LM741AH/883。所述电阻Rc的阻值为10KΩ。
本发明利用上述各单元形成的模块及具体电路,如下所述。
如图23所示,一种不确定轮式移动机器人的自适应轨迹跟踪控制方法,包括误差获取模块、中间变量模块、控制输入模块、参数调节模块、系统模型模块、跟踪目标模块;
系统模型模块的输出端分别与误差获取模块、控制输入模块、参数调节模块连接,系统模型模块的三个输出端分别输出信号v,信号φ,信号w,向误差获取模块输出信号v、信号φ、信号w,向控制输入模块和参数调节模块均输出信号v、信号w;
跟踪目标模块与误差获取模块和中间变量模块连接,向误差获取模块和中间变量模块均输出信号vd和信号φd;
误差获取模块还与中间变量模块、控制输入模块和参数调节模块连接,接收中间变量模块的信号w*,向中间变量模块输出信号e1、信号e2、信号e3,向控制输入模块和参数调节模块均输出信号e1、信号e3;
中间变量模块还分别与控制输入模块、参数调节模块连接,中间变量模块输出的信号Ψ输出到控制输入模块和参数调节模块中;
控制输入模块和参数调节模块连接,控制输入模块接收参数调节模块输出端输出的参数自适应率和参数自适应率
控制输入模块和系统模型模块连接,系统模型模块接收控制输入模块输出端输出的信号u1和信号u2。
参数调节模块
如图10-11所示,参数自适应率电路包括乘法器E1、乘法器E2、同相加法运算单元C1、积分运算放大单元G1,信号e1和信号v对应输入到乘法器E1 的两个输入端,信号e3和信号w对应输入到乘法器E2的两个输入端,乘法器E1 的输出端和乘法器E2的输出端与同相加法运算单元C1的两个输入端连接,同相加法运算单元C1的输出端与积分运算放大单元G1的输入端连接,积分运算放大单元G1的输出端输出参数自适应率
如图12所示,参数自适应率电路包括除法运算放大单元F1、乘法器E3、乘法器E4、反相运算放大单元A1、同相加法运算单元C2、除法运算放大单元 F2、乘法器E5、反相加法运算单元B1、积分运算放大单元G2,除法运算放大单元F1的除数输入端输入参数自适应率被除数输入端输入参数自适应率除法运算放大单元F2除数输入端输入变量Ψ,被除数输入端输入参数自适应率信号e1和信号v对应输入到乘法器E3两个输入端,信号e3和信号w对应输入到乘法器E4两个输入端,乘法器E3和乘法器E4的输出端对应与同相加法运算单元C2的两个输入端连接,除法运算放大单元F1的输出端、同相加法运算单元C2的输出端与乘法器E5的两个输入端对应连接,反相运算放大单元A1的输入端输入参数自适应率除法运算放大单元F2的输出端、反相运算放大单元A1的输出端、乘法器E5的输出端分别对应连接反相加法运算单元B1的三个输入端,反相加法运算单元B1的输出端与积分运算放大单元G2的输入端连接,积分运算放大单元G2的输出端输出参数自适应率乘法器E5的输出端输出信号M。
中间变量模块
中间变量模块包括产生信号ζ的第一中间电路、产生变量的第二中间电路、产生信号的第三中间电路、获得信号w*的第四中间电路、获得变量Ψ的第五中间电路;
如图13所示,第一中间电路包括反相运算放大单元A9、积分运算放大单元G3,反相运算放大单元A9的输入端输入信号e2,反相运算放大单元 A9的输出端与积分运算放大单元G3的输入端连接,积分运算放大单元G3的输出端输出信号ζ;
如图14所示第二中间电路包括依次设置的反相运算放大单元A10和微分运算放大单元H1,反相运算放大单元A10输入端输入信号跟踪目标模块输出的信号vd,微分运算放大单元H1输出端输出信号
如图15所示,第三中间电路包括依次串联设置的反相运算放大单元A11、微分运算放大单元H2、反相运算放大单元A12、微分运算放大单元H3,反相运算放大单元A11输入端输入信号φd,微分运算放大单元H3输出端输出信号微分运算放大单元H3输出端输出信号
如图16所示,第四中间电路包括反相运算放大单元A6、反相运算放大单元A7、反相运算放大单元A8,反相运算放大单元A6、反相运算放大单元A7、反相运算放大单元A8对应的输入端分别输入变量信号e2、信号ζ,反相运算放大单元A6、反相运算放大单元A7、反相运算放大单元A8 作为反相加法运算单元B2的三路输入信号,反相加法运算单元B2输出端输出信号w*;
如图17所示,第五中间电路包括反相运算放大单元A2、反相运算放大单元A3、反相运算放大单元A4、反相运算放大单元A5、同相加法运算单元 C3、减法运算放大单元D1、减法运算放大单元D2、乘法器E6、乘法器E7、同相加法运算单元C4;反相运算放大单元A4、反相运算放大单元A2、反相运算放大单元A5的输入端对应输入信号e1、信号e2、信号e3,反相运算放大单元A3的输入端输入信号ζ,反相运算放大单元A2的输出端和反相运算放大单元A3的输出端对应连接同相加法运算单元C3的两个输入端,同相加法运算单元C3的另一个输入端输入信号反相运算放大单元A5的输出端和同相加法运算单元C3的输出端对应连接到减法运算放大单元D1的减数输入端和被减数输入端,乘法器E6的两个输入端分别输入减法运算放大单元D1 的输出端输出的信号和信号e3;反相运算放大单元A4的输出端连接到减法运算放大单元D2的减数输入端,信号输入到减法运算放大单元D2的被减数输入端,乘法器E7的两个输入端分别输入信号e1和减法运算放大单元D2的输出端信号;乘法器E6的输出端和乘法器E7的输出端对应连接到同相加法运算单元C4的两个输入端,同相加法运算单元C4的输出端输出信号Ψ。
误差获取模块
如图18所示,误差获取模块包括输出信号e1的第一误差电路、输出信号e2的第二误差电路、输出信号e3的第三误差电路,第一误差电路通过减法运算放大单元D3实现e1=vd-v、第二误差电路通过减法运算单元实现e2=φd-φ、第三误差电路通过减法运算单元实现e3=ω*-ω;减法运算放大单元D3的减数输入端输入信号vd,被减数输入端输入信号v。
控制输入模块
控制输入模块包括输出信号u1的第一控制电路、输出信号u2的第二控制电路。
如图19所示,第一控制电路包括反相运算放大单元A13、反相运算放大单元A14、减法运算放大单元D4、反相加法运算单元B3、乘法器E8、乘法器E9、除法运算放大单元F3,反相运算放大单元A13、反相运算放大单元A14输入端对应输入信号e1和信号e3,反相运算放大单元A13和反相运算放大单元A14输出端分别与反相加法运算单元B3的两个输入端连接,减法运算放大单元D4 被减数输入端输入信号减数输入端输入信号M,反相加法运算单元B3输出端与乘法器E8的两个输入端、乘法器E9的一个输入端连接,乘法器E9的另一个输入端与减法运算放大单元D4的输出端连接,乘法器E8与除法运算放大单元F3的除数输入端连接,乘法器E9与除法运算放大单元F3的被除数输入端连接,除法运算放大单元F3的输出端输出信号u1。
如图20所示,第二控制电路包括反相运算放大单元A15、反相运算放大单元A16、反相运算放大单元A17、减法运算放大单元D5、除法运算放大单元F4、除法运算放大单元F5、乘法器E10、乘法器E11,反相运算放大单元A15输入端输入信号e3,反相运算放大单元A15的输出端与反相运算放大单元A16的输入端连接,反相运算放大单元A16输出端与乘法器E10的两个输入端、乘法器 E11的一个输入端连接,乘法器E10的输出端与反相运算放大单元A17的输入端连接;除法运算放大单元F4的被除数端输入信号Ψ,除数端输入信号减法运算放大单元D5减数输入端与除法运算放大单元F4的输出端连接,被减数输入端输入信号减法运算放大单元D5的输出端与乘法器E11的另一个输入端连接;乘法器E11的输出端与除法运算放大单元F5的除数端连接,反相运算放大单元A17的输出端与除法运算放大单元F5的被除数端连接,除法运算放大单元F5的输出端输出信号u2。
系统模型模块
系统模型模块包括产生信号v的第一模型电路和产生信号φ和信号w的第二模型电路;
如图21所示,第一模型电路包括反相运算放大单元A18、反相运算放大单元A19、减法运算放大单元D6、积分运算放大单元G4,反相运算放大单元A18 输入端的输入信号v,反相运算放大单元A19输入端的输入信号u1,反相运算放大单元A18、反相运算放大单元A19的输出端对应连接到减法运算放大单元D6 的减数输入端、被减数输入端,减法运算放大单元D6的输出端与积分运算放大单元G4输入端连接,积分运算放大单元G4的输出端输出信号v,且反馈至反相运算放大单元A18的输入端。
如图22所示,第二模型电路包括反相运算放大单元A20、反相运算放大单元A21、反相运算放大单元A22、反相运算放大单元A23、反相运算放大单元 A24、反相加法运算单元B4、积分运算放大单元G5、积分运算放大单元G6,反相运算放大单元A20输入端的输入信号w,反相运算放大单元A21输入端的输入信号u1,反相运算放大单元A22输入端的输入信号u2,反相运算放大单元 A21输出端的信号经过反相运算放大单元A23输入到反相加法运算单元B4其中的一个输入端,反相运算放大单元A20、反相运算放大单元A22对应连接反相加法运算单元B4的另外两个输入端,反相加法运算单元B4输出端的信号依次经过积分运算放大单元G5、反相运算放大单元A24、积分运算放大单元G6后输出信号φ,积分运算放大单元G5输出端输出信号w,并反馈连接到反相运算放大单元A20的输入端。
利用专业的电路仿真软件Multisim,对于上述的电路在软件上加以仿真,可以得到如图24所示的误差曲线图,从图24可以看出系统误差在1.5s 左右时便接近0了,即自适应控制电路对一种不确定轮式移动机器人的轨迹跟踪控制有很好的效果。
类似图10和图11,其中图12-23根据表四-表七可得对应的电路图。
以上仅为本发明创造的较佳实施例而已,并不用以限制本发明创造,凡在本发明创造的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明创造的保护范围之内。
Claims (5)
1.一种不确定轮式移动机器人的自适应轨迹跟踪控制方法,其特征在于,包括以下步骤:
S1、建立轮式移动机器人的系统模型模块的动力学方程;
S2、采用积分反演策略,通过递推Lyapunov函数的方法,针对机器人系统的未知参数,设计基于Lyapunov稳定性理论建立控制输入模块的模型。
2.根据权利要求1所述的一种不确定轮式移动机器人的自适应轨迹跟踪控制方法,其特征在于,步骤S1中动力学方程为
其中表示机器人前进加速度,v表示机器人前进速度,表示机器人角速度,表示机器人角加速度,a1、b1、a2、b2表示机器人模型参数,u1和u2机器人控制输入。
3.根据权利要求2所述的一种不确定轮式移动机器人的自适应轨迹跟踪控制方法,其特征在于,其中,
c表示轮胎与地面的摩擦系数,M表示机器人总质量,r表示车轮半径,Iw表示驱动轮的转动惯量,L表示机器人宽度的一半,IV表示绕机器人重心的转动惯量,k表示电机及传动机构的驱动增益。
4.根据权利要求1所述的一种不确定轮式移动机器人的自适应轨迹跟踪控制方法,其特征在于,步骤S2中模型方程为
r1、r2、d1、d2表示机器人模型参数,ζ、w*表示机器人中间变量,e1表示速度误差,e2表示角度误差,e3表示角速度误差,Ψ为机器人模型变量,为参数自适应律。
5.根据权利要求4所述的一种不确定轮式移动机器人的自适应轨迹跟踪控制方法,其特征在于,其中,
速度误差e1、角度误差e2、角速度误差e3由误差获取模块处理获得,具体的,e1=vd-v,e2=φd-φ,e3=ω*-ω,机器人中间变量ζ、w*由中间变量模块处理后获得,机器人中间变量ζ、w*的表达式分别为
其中参数自适应律和参数自适应律通过参数调节模块获得,机器人中间变量Ψ通过中间变量模块获得,参数自适应律和参数自适应律的导数、机器人中间变量Ψ表达式为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810878270.0A CN108897224B (zh) | 2018-08-03 | 2018-08-03 | 一种不确定轮式移动机器人的自适应轨迹跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810878270.0A CN108897224B (zh) | 2018-08-03 | 2018-08-03 | 一种不确定轮式移动机器人的自适应轨迹跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108897224A true CN108897224A (zh) | 2018-11-27 |
CN108897224B CN108897224B (zh) | 2021-09-24 |
Family
ID=64353401
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810878270.0A Active CN108897224B (zh) | 2018-08-03 | 2018-08-03 | 一种不确定轮式移动机器人的自适应轨迹跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108897224B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109976161A (zh) * | 2019-04-23 | 2019-07-05 | 哈尔滨工业大学 | 一种不确定非线性系统的有限时间优化跟踪控制方法 |
CN110187637A (zh) * | 2019-06-03 | 2019-08-30 | 重庆大学 | 在控制方向和期望轨迹不确定下的机器人系统控制方法 |
CN111103798A (zh) * | 2019-12-20 | 2020-05-05 | 华南理工大学 | 一种基于反演滑模控制的agv路径跟踪方法 |
CN113985868A (zh) * | 2021-10-09 | 2022-01-28 | 北京科技大学 | 一种轮式移动机器人分层路径跟踪控制实现方法 |
CN116039636A (zh) * | 2022-12-15 | 2023-05-02 | 南通大学 | 考虑车轮打滑的轮式移动机器人自适应神经网络控制方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101436073A (zh) * | 2008-12-03 | 2009-05-20 | 江南大学 | 基于量子行为粒子群算法的轮式移动机器人轨迹跟踪方法 |
CN103926839A (zh) * | 2014-04-23 | 2014-07-16 | 浙江师范大学 | 一种轮式移动机器人的运动分段控制方法 |
CN104932506A (zh) * | 2015-06-09 | 2015-09-23 | 东南大学 | 基于快速终端滑模的轮式移动机器人轨迹跟踪方法 |
CN105607636A (zh) * | 2016-01-21 | 2016-05-25 | 浙江工业大学 | 一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 |
CN105843041A (zh) * | 2016-04-08 | 2016-08-10 | 浙江工业大学 | 一种带有未知滞环的小车倒立摆系统积分滑模控制方法 |
CN106125728A (zh) * | 2016-07-05 | 2016-11-16 | 上海电机学院 | 一种四驱轮式移动机器人轨迹跟踪控制方法 |
CN107024863A (zh) * | 2017-03-24 | 2017-08-08 | 哈尔滨工程大学 | 一种避免微分爆炸的uuv轨迹跟踪控制方法 |
CN108008720A (zh) * | 2017-10-31 | 2018-05-08 | 哈尔滨理工大学 | 一种轮式移动机器人的模糊滑模轨迹跟踪控制及方法 |
-
2018
- 2018-08-03 CN CN201810878270.0A patent/CN108897224B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101436073A (zh) * | 2008-12-03 | 2009-05-20 | 江南大学 | 基于量子行为粒子群算法的轮式移动机器人轨迹跟踪方法 |
CN103926839A (zh) * | 2014-04-23 | 2014-07-16 | 浙江师范大学 | 一种轮式移动机器人的运动分段控制方法 |
CN104932506A (zh) * | 2015-06-09 | 2015-09-23 | 东南大学 | 基于快速终端滑模的轮式移动机器人轨迹跟踪方法 |
CN105607636A (zh) * | 2016-01-21 | 2016-05-25 | 浙江工业大学 | 一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 |
CN105843041A (zh) * | 2016-04-08 | 2016-08-10 | 浙江工业大学 | 一种带有未知滞环的小车倒立摆系统积分滑模控制方法 |
CN106125728A (zh) * | 2016-07-05 | 2016-11-16 | 上海电机学院 | 一种四驱轮式移动机器人轨迹跟踪控制方法 |
CN107024863A (zh) * | 2017-03-24 | 2017-08-08 | 哈尔滨工程大学 | 一种避免微分爆炸的uuv轨迹跟踪控制方法 |
CN108008720A (zh) * | 2017-10-31 | 2018-05-08 | 哈尔滨理工大学 | 一种轮式移动机器人的模糊滑模轨迹跟踪控制及方法 |
Non-Patent Citations (2)
Title |
---|
UMESH KUMAR & NAGARAJAN SUKAVA: "Backstepping based trajectory tracking control of a four wheeled mobile robot", 《INTERNATIONAL JOURNAL OF ADVANCED ROBOTIC SYSTEMS》 * |
孙棣华,等: "具有参数不确定性的轮式移动机器人自适应backsteeping控制", 《控制理论与应用》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109976161A (zh) * | 2019-04-23 | 2019-07-05 | 哈尔滨工业大学 | 一种不确定非线性系统的有限时间优化跟踪控制方法 |
CN109976161B (zh) * | 2019-04-23 | 2022-04-08 | 哈尔滨工业大学 | 一种不确定非线性系统的有限时间优化跟踪控制方法 |
CN110187637A (zh) * | 2019-06-03 | 2019-08-30 | 重庆大学 | 在控制方向和期望轨迹不确定下的机器人系统控制方法 |
CN111103798A (zh) * | 2019-12-20 | 2020-05-05 | 华南理工大学 | 一种基于反演滑模控制的agv路径跟踪方法 |
CN111103798B (zh) * | 2019-12-20 | 2021-03-30 | 华南理工大学 | 一种基于反演滑模控制的agv路径跟踪方法 |
CN113985868A (zh) * | 2021-10-09 | 2022-01-28 | 北京科技大学 | 一种轮式移动机器人分层路径跟踪控制实现方法 |
CN113985868B (zh) * | 2021-10-09 | 2023-08-08 | 北京科技大学 | 一种轮式移动机器人分层路径跟踪控制实现方法 |
CN116039636A (zh) * | 2022-12-15 | 2023-05-02 | 南通大学 | 考虑车轮打滑的轮式移动机器人自适应神经网络控制方法 |
CN116039636B (zh) * | 2022-12-15 | 2024-01-30 | 南通大学 | 考虑车轮打滑的轮式移动机器人自适应神经网络控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108897224B (zh) | 2021-09-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108897224A (zh) | 一种不确定轮式移动机器人的自适应轨迹跟踪控制方法 | |
Li et al. | Velocity-based robust fault tolerant automatic steering control of autonomous ground vehicles via adaptive event triggered network communication | |
Meng et al. | Integrated stability control of AFS and DYC for electric vehicle based on non-smooth control | |
Coelho et al. | Path-following control of mobile robots in presence of uncertainties | |
Yang et al. | Robust tracking control for wheeled mobile robot based on extended state observer | |
CN102343985B (zh) | 带反作用飞轮的卫星时间最优姿态机动方法 | |
CN109857100B (zh) | 一种基于反演法和快速终端滑模的复合轨迹跟踪控制算法 | |
Yoo et al. | Formation tracking control for a class of multiple mobile robots in the presence of unknown skidding and slipping | |
Yang et al. | Dual closed‐loop tracking control for wheeled mobile robots via active disturbance rejection control and model predictive control | |
Yan et al. | Adaptive practical leader‐following formation control of multiple nonholonomic wheeled mobile robots | |
CN107193210A (zh) | 一种非线性系统的自适应学习预设性能控制方法 | |
Ye | Tracking control of a non-holonomic wheeled mobile robot using improved compound cosine function neural networks | |
Ye et al. | The stability and accuracy analysis of automatic steering system with time delay | |
Mauder | Robust tracking control of nonholonomic dynamic systems with application to the bi-steerable mobile robot | |
Chai et al. | Data-driven game-based control of microsatellites for attitude takeover of target spacecraft with disturbance | |
Kar et al. | Trajectory tracking by automated guided vehicle using GA optimized sliding mode control | |
Jin et al. | Adaptive perturbation rejection control and driving voltage circuit designs of wheeled mobile robots | |
CN109062208A (zh) | 一种不确定轮式移动机器人的自适应轨迹跟踪控制电路 | |
Huang et al. | Takagi-sugeno fuzzy H∞ tracking control for steer-by-wire systems | |
Xie et al. | Parameter self‐learning feedforward compensation‐based active disturbance rejection for path‐following control of self‐driving forklift trucks | |
CN116088299A (zh) | 卫星天线混联运动机构神经网络反步控制方法 | |
Yuan et al. | Differential flatness-based adaptive robust tracking control for wheeled mobile robots with slippage disturbances | |
CN115079569A (zh) | 一种基于天牛须搜索算法的agv非线性自抗扰控制方法 | |
Burkan et al. | A model of parameter adaptive law with time varying function for robot control | |
Zhang et al. | Nonlinear Model Predictive Control of an Omnidirectional Mobile Robot with Self-tuned Prediction Horizon |
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 |