CN109062208B - 一种不确定轮式移动机器人的自适应轨迹跟踪控制电路 - Google Patents

一种不确定轮式移动机器人的自适应轨迹跟踪控制电路 Download PDF

Info

Publication number
CN109062208B
CN109062208B CN201810878267.9A CN201810878267A CN109062208B CN 109062208 B CN109062208 B CN 109062208B CN 201810878267 A CN201810878267 A CN 201810878267A CN 109062208 B CN109062208 B CN 109062208B
Authority
CN
China
Prior art keywords
signal
input
unit
inverting
module
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
Application number
CN201810878267.9A
Other languages
English (en)
Other versions
CN109062208A (zh
Inventor
金小峥
赵振
王少凡
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hefei Luyang Technology Innovation Group Co.,Ltd.
Original Assignee
Hefei University of Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Hefei University of Technology filed Critical Hefei University of Technology
Priority to CN201810878267.9A priority Critical patent/CN109062208B/zh
Publication of CN109062208A publication Critical patent/CN109062208A/zh
Application granted granted Critical
Publication of CN109062208B publication Critical patent/CN109062208B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明公开了一种不确定轮式移动机器人的自适应轨迹跟踪控制电路，包括误差获取模块、中间变量模块、控制输入模块、参数调节模块、系统模型模块、跟踪目标模块；系统模型模块的输出端分别与误差获取模块、控制输入模块、参数调节模块连接，跟踪目标模块与误差获取模块和中间变量模块连接，误差获取模块还与中间变量模块、控制输入模块和参数调节模块连接，中间变量模块还分别与控制输入模块、参数调节模块连接，控制输入模块和参数调节模块连接，控制输入模块和系统模型模块连接。该发明的优点在于：控制电路通过各运算单元组合运用，实现的控制电路能较好地补偿系统参数摄动的影响、提高移动机器人的轨迹跟踪性能和鲁棒性。

Description

一种不确定轮式移动机器人的自适应轨迹跟踪控制电路
技术领域
本发明涉及控制电路领域，尤其是一种不确定轮式移动机器人的自适应轨迹跟踪控制电路。
背景技术
轮式移动机器人是一个典型的时延、非线性不稳定系统，其控制问题因其理论挑战性和广泛的实际应用价值而吸引了大批研究者。轮式移动机器人受到纯滚动约束，是典型的非完整系统。其基本运动控制目标可以表述为：1)两个位姿间的移动；2)跟踪一个给定的时间轨迹；3)跟踪一个给定的几何路径。移动机器人的轨迹跟踪控制系统中，由于外界未知干扰的存在以及系统自身的不稳定性缺点，使得轮式移动机器人实际的轨迹与期望轨迹之间总是存在误差的。
为了消除这种误差，各种轨迹跟踪控制技术应运而生。目前，轮式移动机器人轨迹跟踪控制方法大致分为自适应控制，鲁棒控制，神经网络控制，反演控制，滑模控制和模糊控制等。模糊控制(Fuzzy Control)方法克服了传统算法的不足，在移动机器人的轨迹跟踪研究中体现出的控制效果相较于一般控制更优，且具有轨迹跟踪稳定和精度较高的优点。移动机器人是一个典型的时延、非线性不稳定系统，而模糊控制充分发挥其不需要数学模型、运用控制专家的信息及具有鲁棒性的优点而得到广泛的应用。反演控制(BacksteppingControl) 方法是近年来研究非线性系统反馈控制律的热点之一。反演控制方法的基本思想是通过构建Lyapunov函数推导出系统的控制律，采用逆向思维的方法进行设计。基于反演控制技术的移动机器人控制器的设计可以有效地解决不确定性系统的稳定性。自适应控制(Adaptive Control)的研究对象是具有一定程度不确定性的系统，和常规的反馈控制和最优控制一样，也是一种基于数学模型的控制方法，所不同的只是自适应控制所依据的关于模型和扰动的先验知识比较少，需要在系统的运行过程中去不断提取有关模型的信息，使模型逐步完善，这个特点刚好适用于参数不确定轮式移动机器人的轨迹跟踪问题。
现有的学术成果不乏有高级控制策略被设计出来解决参数不确定轮式移动机器人的轨迹跟踪问题，但是还未被开发处较好地补偿系统参数摄动的影响、提高移动机器人的轨迹跟踪性能和鲁棒性的控制电路。
发明内容
为了克服上述现有技术存在的不足，为此，本发明提供一种不确定轮式移动机器人的自适应轨迹跟踪控制电路。
为实现上述目的，本发明采用以下技术方案：
一种不确定轮式移动机器人的自适应轨迹跟踪控制电路，包括误差获取模块、中间变量模块、控制输入模块、参数调节模块、系统模型模块、跟踪目标模块；
所述系统模型模块的输出端分别与误差获取模块、控制输入模块、参数调节模块连接，系统模型模块的三个输出端分别输出信号v，信号φ，信号w，向误差获取模块输出信号v、信号φ、信号w，向控制输入模块和参数调节模块均输出信号v、信号w；
跟踪目标模块与误差获取模块和中间变量模块连接，向误差获取模块和中间变量模块均输出信号vd和信号φd；
误差获取模块还与中间变量模块、控制输入模块和参数调节模块连接，接收中间变量模块的信号w*，向中间变量模块输出信号e1、信号e2、信号e3，向控制输入模块和参数调节模块均输出信号e1、信号e3；
中间变量模块还分别与控制输入模块、参数调节模块连接，中间变量模块输出的信号Ψ输出到控制输入模块和参数调节模块中；
控制输入模块和参数调节模块连接，控制输入模块接收参数调节模块输出端输出的参数自适应率
Figure GDA0003077839420000021
和参数自适应率
Figure GDA0003077839420000022
控制输入模块和系统模型模块连接，系统模型模块接收控制输入模块输出端输出的信号u1和信号u2。
优化的，所述参数调节模块包括参数自适应率
Figure GDA0003077839420000023
电路和参数自适应率
Figure GDA0003077839420000024
电路，所述参数自适应率
Figure GDA0003077839420000031
电路包括乘法器E1、乘法器E2、同相加法运算单元C1、积分运算放大单元G1，信号e1和信号v对应输入到乘法器E1的两个输入端，信号e3和信号w对应输入到乘法器E2的两个输入端，乘法器E1的输出端和乘法器 E2的输出端与同相加法运算单元C1的两个输入端连接，同相加法运算单元C1 的输出端与积分运算放大单元G1的输入端连接，积分运算放大单元G1的输出端输出参数自适应率
Figure GDA0003077839420000032
参数自适应率
Figure GDA0003077839420000033
电路包括除法运算放大单元F1、乘法器E3、乘法器E4、反相运算放大单元A1、同相加法运算单元C2、除法运算放大单元F2、乘法器 E5、反相加法运算单元B1、积分运算放大单元G2，除法运算放大单元F1的除数输入端输入参数自适应率
Figure GDA0003077839420000034
被除数输入端输入参数自适应率
Figure GDA0003077839420000035
除法运算放大单元F2除数输入端输入变量Ψ，被除数输入端输入参数自适应率
Figure GDA0003077839420000036
信号 e1和信号v对应输入到乘法器E3两个输入端，信号e3和信号w对应输入到乘法器 E4两个输入端，乘法器E3和乘法器E4的输出端对应与同相加法运算单元C2的两个输入端连接，除法运算放大单元F1的输出端、同相加法运算单元C2的输出端与乘法器E5的两个输入端对应连接，反相运算放大单元A1的输入端输入参数自适应率
Figure GDA0003077839420000037
除法运算放大单元F2的输出端、反相运算放大单元A1的输出端、乘法器E5的输出端分别对应连接反相加法运算单元B1的三个输入端，反相加法运算单元B1的输出端与积分运算放大单元G2的输入端连接，积分运算放大单元G2的输出端输出参数自适应率
Figure GDA0003077839420000038
乘法器E5的输出端输出信号M。
优化的，所述中间变量模块包括产生信号ζ的第一中间电路、产生变量
Figure GDA0003077839420000039
的第二中间电路、产生信号
Figure GDA00030778394200000310
的第三中间电路、获得信号w*的第四中间电路、获得变量Ψ的第五中间电路；
第一中间电路包括反相运算放大单元A9、积分运算放大单元G3，反相运算放大单元A9的输入端输入信号e2，反相运算放大单元A9的输出端与积分运算放大单元G3的输入端连接，积分运算放大单元G3的输出端输出信号ζ；
第二中间电路包括依次设置的反相运算放大单元A10和微分运算放大单元H1，反相运算放大单元A10输入端输入信号跟踪目标模块输出的信号vd，微分运算放大单元H1输出端输出信号
Figure GDA0003077839420000041
第三中间电路包括依次串联设置的反相运算放大单元A11、微分运算放大单元H2、反相运算放大单元A12、微分运算放大单元H3，反相运算放大单元 A11输入端输入信号φd，微分运算放大单元H3输出端输出信号
Figure GDA0003077839420000042
微分运算放大单元H3输出端输出信号
Figure GDA0003077839420000043
第四中间电路包括反相运算放大单元A6、反相运算放大单元A7、反相运算放大单元A8，反相运算放大单元A6、反相运算放大单元A7、反相运算放大单元A8对应的输入端分别输入变量
Figure GDA0003077839420000044
信号e2、信号ζ，反相运算放大单元A6、反相运算放大单元A7、反相运算放大单元A8作为反相加法运算单元B2的三路输入信号，反相加法运算单元B2输出端输出信号w*；
第五中间电路包括反相运算放大单元A2、反相运算放大单元A3、反相运算放大单元A4、反相运算放大单元A5、同相加法运算单元C3、减法运算放大单元D1、减法运算放大单元D2、乘法器E6、乘法器E7、同相加法运算单元C4；反相运算放大单元A4、反相运算放大单元A2、反相运算放大单元 A5的输入端对应输入信号e1、信号e2、信号e3，反相运算放大单元A3的输入端输入信号ζ，反相运算放大单元A2的输出端和反相运算放大单元A3 的输出端对应连接同相加法运算单元C3的两个输入端，同相加法运算单元 C3的另一个输入端输入信号
Figure GDA0003077839420000045
反相运算放大单元A5的输出端和同相加法运算单元C3的输出端对应连接到减法运算放大单元D1的减数输入端和被减数输入端，乘法器E6的两个输入端分别输入减法运算放大单元D1的输出端输出的信号和信号e3；反相运算放大单元A4的输出端连接到减法运算放大单元 D2的减数输入端，信号
Figure GDA0003077839420000046
输入到减法运算放大单元D2的被减数输入端，乘法器E7的两个输入端分别输入信号e1和减法运算放大单元D2的输出端信号；乘法器E6的输出端和乘法器E7的输出端对应连接到同相加法运算单元C4的两个输入端，同相加法运算单元C4的输出端输出信号Ψ。
优化的，所述误差获取模块包括输出信号e1的第一误差电路、输出信号e2的第二误差电路、输出信号e3的第三误差电路，第一误差电路通过减法运算放大单元D3实现e1＝vd-v、第二误差电路通过减法运算单元实现e2＝φd-φ、第三误差电路通过减法运算单元实现e3＝ω*-ω；减法运算放大单元D3的减数输入端输入信号vd，被减数输入端输入信号v。
优化的，控制输入模块包括输出信号u1的第一控制电路、输出信号u2的第二控制电路；
第一控制电路包括反相运算放大单元A13、反相运算放大单元A14、减法运算放大单元D4、反相加法运算单元B3、乘法器E8、乘法器E9、除法运算放大单元F3，反相运算放大单元A13、反相运算放大单元A14输入端对应输入信号e1和信号e3，反相运算放大单元A13和反相运算放大单元A14输出端分别与反相加法运算单元B3的两个输入端连接，减法运算放大单元D4被减数输入端输入信号
Figure GDA0003077839420000051
减数输入端输入信号M，反相加法运算单元B3输出端与乘法器E8的两个输入端、乘法器E9的一个输入端连接，乘法器E9的另一个输入端与减法运算放大单元D4的输出端连接，乘法器E8与除法运算放大单元F3的除数输入端连接，乘法器E9与除法运算放大单元F3的被除数输入端连接，除法运算放大单元F3的输出端输出信号u1；
第二控制电路包括反相运算放大单元A15、反相运算放大单元A16、反相运算放大单元A17、减法运算放大单元D5、除法运算放大单元F4、除法运算放大单元F5、乘法器E10、乘法器E11，反相运算放大单元A15输入端输入信号e3，反相运算放大单元A15的输出端与反相运算放大单元A16的输入端连接，反相运算放大单元A16输出端与乘法器E10的两个输入端、乘法器E11的一个输入端连接，乘法器E10的输出端与反相运算放大单元A17的输入端连接；除法运算放大单元F4的被除数端输入信号Ψ，除数端输入信号
Figure GDA0003077839420000052
减法运算放大单元 D5减数输入端与除法运算放大单元F4的输出端连接，被减数输入端输入信号
Figure GDA0003077839420000053
减法运算放大单元D5的输出端与乘法器E11的另一个输入端连接；乘法器E11 的输出端与除法运算放大单元F5的除数端连接，反相运算放大单元A17的输出端与除法运算放大单元F5的被除数端连接，除法运算放大单元F5的输出端输出信号u2。
优化的，所述系统模型模块包括产生信号v的第一模型电路和产生信号φ和信号w的第二模型电路；
第一模型电路包括反相运算放大单元A18、反相运算放大单元A19、减法运算放大单元D6、积分运算放大单元G4，反相运算放大单元A18输入端的输入信号v，反相运算放大单元A19输入端的输入信号u1，反相运算放大单元A18、反相运算放大单元A19的输出端对应连接到减法运算放大单元D6的减数输入端、被减数输入端，减法运算放大单元D6的输出端与积分运算放大单元G4输入端连接，积分运算放大单元G4的输出端输出信号v，且反馈至反相运算放大单元A18的输入端；
第二模型电路包括反相运算放大单元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的输入端。
本发明的优点在于：
(1)本发明的控制电路利用现有的运算放大器及电阻、电容、乘法器和除法器普通电子元器件形成各运算单元，然后通过各运算单元组合运用，实现的控制电路能较好地补偿系统参数摄动的影响、提高移动机器人的轨迹跟踪性能和鲁棒性。自适应轨迹跟踪控制电路以控制模块形式在参数不确定轮式移动机器人系统控制层易于实现，并可以在系统部分参数未知，以及外界扰动的界限也未知的情况下自动调节控制参数，提高控制精度，以保证移动机器人的轨迹跟踪性能和鲁棒性，具有较好的实际应用价值和社会意义。
(2)本专利利用理论分析结果，在控制算法上加以创新和改进，运用自适应技术实时补偿参数摄动的影响，设计一个与之相对的控制电路模块物理实现自适应控制策略，以应用于实际的移动机器人的轨迹跟踪控制系统中。
(3)本发明中方法可以克服外部扰动，稳定性强。
附图说明
图1 为电路设计中所需的反相运算放大单元的电路原理图。
图2 为电路设计中所需的反相加法运算单元的电路原理图。
图3 为电路设计中所需的同相加法运算单元的电路原理图。
图4 为电路设计中所需的减法运算放大单元的电路原理图。
图5 为电路设计中所需的乘法器的电路原理图。
图6 为电路设计中所需的除法运算放大单元的电路原理图。
图7 为电路设计中所需的积分运算放大单元的电路原理图。
图8 为电路设计中所需的微分运算放大单元的电路原理图。
图9 为机器人运动示意图。
图10 为参数自适应率
Figure GDA0003077839420000071
电路设计的结构框图。
图11 为参数自适应率
Figure GDA0003077839420000072
电路设计的详细电路原理图。
图12 为参数自适应率
Figure GDA0003077839420000073
电路设计的结构框图。
图13 为中间变量ζ电路设计的结构框图。
图14 为中间变量
Figure GDA0003077839420000074
电路设计的结构框图。
图15 为中间变量
Figure GDA0003077839420000075
和
Figure GDA0003077839420000076
电路设计的结构框图。
图16 为中间变量w*电路设计的结构框图。
图17 为中间变量Ψ电路设计的结构框图。
图18 为系统误差e1电路设计的结构框图。
图19 为控制算法u1电路设计的结构框图。
图20 为控制算法u2电路设计的结构框图。
图21 为子系统
Figure GDA0003077839420000081
电路设计的结构框图。
图22 为子系统φ电路设计的结构框图。
图23 为总电路的系统结构框图。
图24 为本发明电路在Multisim仿真中的系统误差曲线图
具体实施方式
在轮式移动机器人系统控制层中，有2个所要控制的状态，分别是机器人前进的速度和机器人的方向角。为了更加详细的说明本专利，我们以两轮独立驱动的移动机器人为例。该移动机器人的两个前轮为独立驱动轮，各采用一台直流伺服电机独立驱动,通过调节各自的输入电压以实现两前轮的速度差,达到调整车体与跟踪轨迹的位置关系。移动机器人的后轮为随动轮，仅起支撑车体的作用，而无导向作用。
系统控制方法，包括以下步骤：
S1、建立轮式移动机器人的系统模型模块的动力学方程，动力学方程为
Figure GDA0003077839420000082
Figure GDA0003077839420000083
其中
Figure GDA0003077839420000084
表示机器人前进加速度，v表示机器人前进速度，
Figure GDA0003077839420000085
表示机器人角速度，
Figure GDA0003077839420000086
表示机器人角加速度，a1、b1、a2、b2表示机器人模型参数，u1和u2机器人控制输入；
其中，
Figure GDA0003077839420000087
c表示轮胎与地面的摩擦系数，m表示机器人总质量，r表示车轮半径，Iw表示驱动轮的转动惯量，L表示机器人宽度的一半，IV表示绕机器人重心的转动惯量，k表示电机及传动机构的驱动增益，机器人运动示意图如图1所示。
S2、采用积分反演策略，通过递推Lyapunov函数的方法，针对机器人系统的未知参数，设计基于Lyapunov稳定性理论建立控制输入模块的模型，模型方程为
Figure GDA0003077839420000088
Figure GDA0003077839420000091
r1、r2、d1、d2表示机器人模型参数，ζ、w*表示机器人中间变量，e1表示速度误差，e2表示角度误差，e3表示角速度误差，Ψ为机器人模型变量，
Figure GDA0003077839420000092
为参数自适应律；
其中，
Figure GDA0003077839420000093
速度误差e1、角度误差e2、角速度误差e3由误差获取模块处理获得，具体的， e1＝vd-v，e2＝φd-φ，e3＝ω*-ω，机器人中间变量ζ、w*由中间变量模块处理后获得，机器人中间变量ζ、w*的表达式分别为
Figure GDA0003077839420000094
其中参数自适应律
Figure GDA0003077839420000095
和参数自适应律
Figure GDA0003077839420000096
通过参数调节模块获得，机器人中间变量Ψ通过中间变量模块获得，参数自适应律
Figure GDA0003077839420000097
和参数自适应律
Figure GDA0003077839420000098
的导数、机器人中间变量Ψ表达式为：
Figure GDA0003077839420000099
Figure GDA00030778394200000910
Figure GDA00030778394200000911
通过以上的控制器设计，利用Lyapunov稳定性理论可以证明控制器的有效性：
定义Lyapunov函数为
Figure GDA00030778394200000912
其中
Figure GDA00030778394200000913
对公式(8)进行求导得
Figure GDA00030778394200000914
将上述所设计的控制器公式(3)-公式(7)代入至
Figure GDA00030778394200000915
式子中，并通过缩放最终可以获得：
Figure GDA00030778394200000916
其中k1，k2，k3都大于0，即
Figure GDA00030778394200000917
通过Lyapunov稳定性理论可以得知，以上所设计的控制器完全可以使系统稳定，即证明了该控制器的有效性。
根据这些理论的结果，我们可以利用运算放大电路的相关知识设计出相对应的运算电路来实现此类自适应backstepping的算法以应用于具体的工业环境。
在该实施例中，移动机器人模型的物理参数如下表一所示。
名称 符号 标称值
质量 m 50kg
驱动轮半径 r 0.125m
车轮与地面间摩擦系数 c 0.05kg·m<sup>2</sup>/s
绕机器人重心转动惯量 I<sub>V</sub> 10kg·m<sup>2</sup>
轮子转动惯量 I<sub>W</sub> 0.05kg·m<sup>2</sup>
两驱动轮到机器人重心距离 L 0.5m
电机及传动机构的驱动增益 k 20Nm/V
表一根据系统模型物理参数知机器人参数的具体对应的值如下表二所示。
参数 a<sub>1</sub> a<sub>2</sub> b<sub>1</sub> b<sub>2</sub> r<sub>1</sub> r<sub>2</sub> d<sub>1</sub> d<sub>2</sub>
数值 -0.1135 -0.1379 2.8369 6.8966 -2.2695 -2.7586 0.1418 0.3448
表二经过反复的实验与比较得出控制效果较好的控制参数，如下表三所示。
控制参数 k<sub>0</sub> k<sub>1</sub> k<sub>2</sub> k<sub>3</sub> λ<sub>1</sub> λ<sub>2</sub>
数值 20 10.3 16 14.5 1 1
表三
下面将根据以上的参数与所设计的控制器设计移动机器人的运算电路系统与控制算法。
为实现各模块电路，在该实施例中，针对基础电路即反相运算放大单元、反相加法运算单元、同相加法运算单元、除法运算放大单元、减法运算单元、积分运算放大单元、乘法器单元和微分运算放大单元做如下说明。
反相运算放大单元
如图1 所示，反相运算放大单元包括电阻R1、电阻Rf、运算放大器，所述反相运算放大单元的输入端经过电阻R1连接在运算放大器的负输入端，运算放大器的正输入端经过电阻Rc与地连接，所述运算放大器的输出端作为反相运算放大单元的输出端。
电阻R1、电阻Rf为根据比例运算的要求而设定的阻值。应用运算放大器的虚短、虚断的知识可知运放的反相输入端输入电压ui，可以得到输出端电压
Figure GDA0003077839420000101
始终设置R1＝10KΩ，这样只要设置Rf的阻值就可以得到相应的比例关系。表四表示各反相运算放大单元中Rf的值对应的输入输出关系。
反相运算放大单元 R<sub>f</sub>的阻值(kΩ) 输入输出关系
A1 20 u<sub>o</sub>＝-2u<sub>i</sub>
A2 2350 u<sub>o</sub>＝-235u<sub>i</sub>
A3 3200 u<sub>o</sub>＝-320u<sub>i</sub>
A4 103 u<sub>o</sub>＝-10.3u<sub>i</sub>
A5 305 u<sub>o</sub>＝-30.5u<sub>i</sub>
A6 10 u<sub>o</sub>＝-u<sub>i</sub>
A7 160 u<sub>o</sub>＝-16u<sub>i</sub>
A8 200 u<sub>o</sub>＝-20u<sub>i</sub>
A9 10 u<sub>o</sub>＝-u<sub>i</sub>
A10 10 u<sub>o</sub>＝-u<sub>i</sub>
A11 10 u<sub>o</sub>＝-u<sub>i</sub>
A12 10 u<sub>o</sub>＝-u<sub>i</sub>
A13 1.418 u<sub>o</sub>＝-0.1418u<sub>i</sub>
A14 3.448 u<sub>o</sub>＝-0.3448u<sub>i</sub>
A15 3.448 u<sub>o</sub>＝-0.3448u<sub>i</sub>
A16 10 u<sub>o</sub>＝-u<sub>i</sub>
A17 20 u<sub>o</sub>＝-2u<sub>i</sub>
A18 1.135 u<sub>o</sub>＝-0.1135u<sub>i</sub>
A19 28.369 u<sub>o</sub>＝-2.8369u<sub>i</sub>
A20 1.379 u<sub>o</sub>＝-0.1379u<sub>i</sub>
A21 68.966 u<sub>o</sub>＝-6.8966u<sub>i</sub>
A22 137.932 u<sub>o</sub>＝-13.7932u<sub>i</sub>
A23 10 u<sub>o</sub>＝-u<sub>i</sub>
A24 10 u<sub>o</sub>＝-u<sub>i</sub>
表四
反相加法运算单元
如图2 所示，反相加法运算单元包括r+2个电阻Rc、运算放大器，运算放大器的正极经过其中一个电阻Rc与地连接，另一个电阻Rc连接在运算放大器的负输入端和输出端之间，r个输入端分别经过相应的电阻Rc与运算放大器的负输入端连接，所述运算放大器的输出端作为反相加法运算单元的输出端。r表示输入端个数。
运算放大器的反相输入端接入电压分别为ui1、ui2…uir，则在放大器的输出端可以得到电压uo＝-(ui1+ui2+...+uir)。表五表示各反相加法运算单元对应的输入输出关系。
反相加法运算单元 输入端个数(个) 输入输出关系
B1 3 u<sub>o</sub>＝-(u<sub>1</sub>+u<sub>2</sub>+u<sub>3</sub>)
B2 3 u<sub>o</sub>＝-(u<sub>1</sub>+u<sub>2</sub>+u<sub>3</sub>)
B3 2 u<sub>o</sub>＝-(u<sub>1</sub>+u<sub>2</sub>)
B4 3 u<sub>o</sub>＝-(u<sub>1</sub>+u<sub>2</sub>+u<sub>3</sub>)
表五
同向加法运算单元
如图3 所示，同相加法运算单元包括电阻Rf、r+1个电阻Rc、运算放大器，运算放大器的负输入端经过其中一个电阻Rc与地连接，并接经过电阻Rf与运算放大器的输出端连接，r个输入端分别经过相应的电阻Rc与运算放大器的正输入端连接，即所述运算放大器的输出端可作为同相加法运算单元的输出端。
运算放大器的同相输入端接入电压ui1、ui2…uir，此时设置 Rf＝r×10KΩ，则在放大器的输出端可以得到电压uo＝ui1+ui2+...+uir。下表表六表示各同相加法运算单元对应的输入输出关系。
同相加法运算单元 R<sub>f</sub>的阻值(kΩ) 输入输出关系
C1 20 u<sub>o</sub>＝u<sub>i1</sub>+u<sub>i2</sub>
C2 20 u<sub>o</sub>＝u<sub>i1</sub>+u<sub>i2</sub>
C3 30 u<sub>o</sub>＝u<sub>i1</sub>+u<sub>i2</sub>+u<sub>i3</sub>
C4 20 u<sub>o</sub>＝u<sub>i1</sub>+u<sub>i2</sub>
表六
减法运算单元
如图4 所示，减法运算单元包括电阻Rf、3个电阻Rc、运算放大器，运算放大器的负输入端经过其中一个电阻Rc接输入电压ui2，并经过电阻Rf与运算放大器的输出端连接，运算放大器的正输入端经过其中一个电阻Rc接输入电压ui1，同时经过另一个电阻Rc与地连接，则所述运算放大器的输出端可作为减法运算单元的输出端。即在放大器的输出端可以得到电压 uo＝ui1-ui2。后面电路图所用的减法运算单元D1、D2、D3均是用上述方法实现的。
乘法器单元
如图5 所示，乘法器单元有两个输入端分别接入电压ui1和ui2，且乘法器单元增益为k，则在乘法器单元的输出端可得到电压uo＝k×ui1×ui2。下表表七表示各乘法器单元对应的输入输出关系。
乘法器单元 增益K的值 输入输出关系
E1 -2.2695 u<sub>o</sub>＝-2.2695×u<sub>i1</sub>×u<sub>i2</sub>
E2 -2.7586 u<sub>o</sub>＝-2.7586×u<sub>i1</sub>×u<sub>i2</sub>
E3 -2.2695 u<sub>o</sub>＝-2.2695×u<sub>i1</sub>×u<sub>i2</sub>
E4 -2.7586 u<sub>o</sub>＝-2.7586×u<sub>i1</sub>×u<sub>i2</sub>
E5 -1 u<sub>o</sub>＝-1×u<sub>i1</sub>×u<sub>i2</sub>
E6 1 u<sub>o</sub>＝1×u<sub>i1</sub>×u<sub>i2</sub>
E7 1 u<sub>o</sub>＝1×u<sub>i1</sub>×u<sub>i2</sub>
E8 1 u<sub>o</sub>＝1×u<sub>i1</sub>×u<sub>i2</sub>
E9 -1 u<sub>o</sub>＝-1×u<sub>i1</sub>×u<sub>i2</sub>
E10 -1 u<sub>o</sub>＝-1×u<sub>i1</sub>×u<sub>i2</sub>
E11 1 u<sub>o</sub>＝1×u<sub>i1</sub>×u<sub>i2</sub>
表七
除法运算放大单元
如图6 所示，除法运算放大单元包括增益为1的乘法器、3个电阻Rc、运算放大器，一个输入端经过第一个电阻Rc与运算放大器的负输入端连接，另一个输入端与乘法器的一个输入端连接，乘法器的另一个输入端与运算放大器的输出端连接，乘法器的输出端经过第二个电阻Rc与运算放大器的负输入端连接，运算放大器的正输入端经过第三个电阻Rc与地连接，所述运算放大器的输出端作为除法运算放大单元的输出端。
在运算放大器的反相输入端接入电压ui1，在乘法器的输入端接入电压 ui2，通过运算放大器的电路知识可以得到放大器的输出电压
Figure GDA0003077839420000131
其中要保证ui2＞0，否则不能实现除法运算。后面电路图所用的除法运算放大单元F1、F2、F3均是用上述方法实现的。
积分运算放大单元
如图7 所示，积分运算放大单元包括电阻R1、电容Cf、电阻R2、运算放大器，积分运算放大单元的输入端经过电阻R1与运算放大器的负输入端连接，运算放大器的负输入端经过电容Cf与运算放大器的输出端连接，运算放大器的正输入端经过电阻R2与地连接，所述运算放大器的输出端作为积分运算放大单元的输出端。
在输入端接入电压ui,则在积分运算放大单元的输出端可获得电压
Figure GDA0003077839420000141
在设计控制器时通常需要uo＝∫uidt，则令R1＝100kΩ、 Cf＝10uF，R2＝100kΩ，则uo＝-∫uidt。后面电路图所用的积分运算放大单元 G1、G2、G3均是用上述方法实现的。
微分运算放大单元
如图8 所示，微分运算放大单元包括电阻R1、电容Cf、电阻R2、运算放大器，积分运算放大单元的输入端经过电容Cf与运算放大器的负输入端连接，运算放大器的负输入端经过电阻R1与运算放大器的输出端连接，运算放大器的正输入端经过电阻R2与地连接，所述运算放大器的输出端作为微分运算放大单元的输出端。
在输入端接入电压ui,则在微分运算放大单元的输出端可获得电压
Figure GDA0003077839420000142
在设计控制器时需要
Figure GDA0003077839420000143
则令R1＝100kΩ、Cf＝10uF， R2＝100kΩ，则
Figure GDA0003077839420000144
后面电路图所用的积分运算放大单元H1、H2、 H3均是用上述方法实现的。
在上述电路设计中的基础电路的说明中，所用到的运算放大器的型号为LM741AH/883。所述电阻Rc的阻值为10KΩ。
本发明利用上述各单元形成的模块及具体电路，如下所述。
如图23 所示，一种不确定轮式移动机器人的自适应轨迹跟踪控制电路 ，包括误差获取模块、中间变量模块、控制输入模块、参数调节模块、系统模型模块、跟踪目标模块；
系统模型模块的输出端分别与误差获取模块、控制输入模块、参数调节模块连接，系统模型模块的三个输出端分别输出信号v，信号φ，信号w，向误差获取模块输出信号v、信号φ、信号w，向控制输入模块和参数调节模块均输出信号v、信号w；
跟踪目标模块与误差获取模块和中间变量模块连接，向误差获取模块和中间变量模块均输出信号vd和信号φd；
误差获取模块还与中间变量模块、控制输入模块和参数调节模块连接，接收中间变量模块的信号w*，向中间变量模块输出信号e1、信号e2、信号e3，向控制输入模块和参数调节模块均输出信号e1、信号e3；
中间变量模块还分别与控制输入模块、参数调节模块连接，中间变量模块输出的信号Ψ输出到控制输入模块和参数调节模块中；
控制输入模块和参数调节模块连接，控制输入模块接收参数调节模块输出端输出的参数自适应率
Figure GDA0003077839420000151
和参数自适应率
Figure GDA0003077839420000152
控制输入模块和系统模型模块连接，系统模型模块接收控制输入模块输出端输出的信号u1和信号u2。
参数调节模块
如图10 -11 所示，参数自适应率
Figure GDA0003077839420000153
电路包括乘法器E1、乘法器E2、同相加法运算单元C1、积分运算放大单元G1，信号e1和信号v对应输入到乘法器E1的两个输入端，信号e3和信号w对应输入到乘法器E2的两个输入端，乘法器E1的输出端和乘法器E2的输出端与同相加法运算单元C1的两个输入端连接，同相加法运算单元C1的输出端与积分运算放大单元G1的输入端连接，积分运算放大单元G1的输出端输出参数自适应率
Figure GDA0003077839420000154
如图12 所示，参数自适应率
Figure GDA0003077839420000155
电路包括除法运算放大单元F1、乘法器E3、乘法器E4、反相运算放大单元A1、同相加法运算单元C2、除法运算放大单元 F2、乘法器E5、反相加法运算单元B1、积分运算放大单元G2，除法运算放大单元F1的除数输入端输入参数自适应率
Figure GDA0003077839420000156
被除数输入端输入参数自适应率
Figure GDA0003077839420000157
除法运算放大单元F2除数输入端输入变量Ψ，被除数输入端输入参数自适应率
Figure GDA0003077839420000161
信号e1和信号v对应输入到乘法器E3两个输入端，信号e3和信号w对应输入到乘法器E4两个输入端，乘法器E3和乘法器E4的输出端对应与同相加法运算单元C2的两个输入端连接，除法运算放大单元F1的输出端、同相加法运算单元C2的输出端与乘法器E5的两个输入端对应连接，反相运算放大单元A1的输入端输入参数自适应率
Figure GDA0003077839420000162
除法运算放大单元F2的输出端、反相运算放大单元A1的输出端、乘法器E5的输出端分别对应连接反相加法运算单元B1的三个输入端，反相加法运算单元B1的输出端与积分运算放大单元G2的输入端连接，积分运算放大单元G2的输出端输出参数自适应率
Figure GDA0003077839420000163
乘法器E5的输出端输出信号M。
中间变量模块
中间变量模块包括产生信号ζ的第一中间电路、产生变量
Figure GDA0003077839420000164
的第二中间电路、产生信号
Figure GDA0003077839420000165
的第三中间电路、获得信号w*的第四中间电路、获得变量Ψ的第五中间电路；
如图13 所示，第一中间电路包括反相运算放大单元A9、积分运算放大单元G3，反相运算放大单元A9的输入端输入信号e2，反相运算放大单元 A9的输出端与积分运算放大单元G3的输入端连接，积分运算放大单元G3的输出端输出信号ζ；
如图14 所示第二中间电路包括依次设置的反相运算放大单元A10和微分运算放大单元H1，反相运算放大单元A10输入端输入信号跟踪目标模块输出的信号vd，微分运算放大单元H1输出端输出信号
Figure GDA0003077839420000166
如图15 所示，第三中间电路包括依次串联设置的反相运算放大单元A11、微分运算放大单元H2、反相运算放大单元A12、微分运算放大单元H3，反相运算放大单元A11输入端输入信号φd，微分运算放大单元H3输出端输出信号
Figure GDA0003077839420000167
微分运算放大单元H3输出端输出信号
Figure GDA0003077839420000168
如图16 所示，第四中间电路包括反相运算放大单元A6、反相运算放大单元A7、反相运算放大单元A8，反相运算放大单元A6、反相运算放大单元A7、反相运算放大单元A8对应的输入端分别输入变量
Figure GDA0003077839420000171
信号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的另一个输入端输入信号
Figure GDA0003077839420000172
反相运算放大单元A5的输出端和同相加法运算单元C3的输出端对应连接到减法运算放大单元D1的减数输入端和被减数输入端，乘法器E6的两个输入端分别输入减法运算放大单元D1 的输出端输出的信号和信号e3；反相运算放大单元A4的输出端连接到减法运算放大单元D2的减数输入端，信号
Figure GDA0003077839420000173
输入到减法运算放大单元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 被减数输入端输入信号
Figure GDA0003077839420000181
减数输入端输入信号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的被除数端输入信号Ψ，除数端输入信号
Figure GDA0003077839420000182
减法运算放大单元D5减数输入端与除法运算放大单元F4的输出端连接，被减数输入端输入信号
Figure GDA0003077839420000183
减法运算放大单元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 -22 根据表四-表七可得对应的电路图。
以上仅为本发明创造的较佳实施例而已，并不用以限制本发明创造，凡在本发明创造的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明创造的保护范围之内。

Claims (6)

1.一种不确定轮式移动机器人的自适应轨迹跟踪控制电路，其特征在于，包括误差获取模块、中间变量模块、控制输入模块、参数调节模块、系统模型模块、跟踪目标模块；
所述系统模型模块的输出端分别与误差获取模块、控制输入模块、参数调节模块连接，系统模型模块的三个输出端分别输出信号v，信号φ，信号w，向误差获取模块输出信号v、信号φ、信号w，向控制输入模块和参数调节模块均输出信号v、信号w；
跟踪目标模块与误差获取模块和中间变量模块连接，向误差获取模块和中间变量模块均输出信号vd和信号φd；
误差获取模块还与中间变量模块、控制输入模块和参数调节模块连接，接收中间变量模块的信号w*，向中间变量模块输出信号e1、信号e2、信号e3，向控制输入模块和参数调节模块均输出信号e1、信号e3；
中间变量模块还分别与控制输入模块、参数调节模块连接，中间变量模块输出的信号Ψ输出到控制输入模块和参数调节模块中；
控制输入模块和参数调节模块连接，控制输入模块接收参数调节模块输出端输出的参数自适应率
Figure FDA0003077839410000011
和参数自适应率
Figure FDA0003077839410000012
控制输入模块和系统模型模块连接，系统模型模块接收控制输入模块输出端输出的信号u1和信号u2；
信号v表示机器人前进速度，信号φ表示机器人方位角度，信号w表示机器人角速度；
信号vd和φd分别为已给定的机器人前进速度v和方位角度φ的期望参考轨迹，信号vd和φd由跟踪目标模块处理后获得；
控制输入模块的模型为：
Figure FDA0003077839410000013
Figure FDA0003077839410000014
其中，r1、r2、d1、d2表示机器人模型参数，ζ、w*表示机器人中间变量，e1表示速度误差，e2表示角度误差，e3表示角速度误差，Ψ为机器人模型变量，
Figure FDA0003077839410000021
Figure FDA0003077839410000022
为参数自适应律；
Figure FDA0003077839410000023
m表示机器人总质量，r表示车轮半径，Iw表示驱动轮的转动惯量，L表示机器人宽度的一半，IV表示绕机器人重心的转动惯量；
速度误差e1、角度误差e2、角速度误差e3由误差获取模块处理获得，e1＝vd-v，e2＝φd-φ，e3＝ω*-ω；
w*为机器人中间变量，通过中间变量模块处理后获得，
Figure FDA0003077839410000024
Figure FDA0003077839410000025
为φd的导数；
ζ为机器人中间变量，在中间变量模块的处理过程中获得，
Figure FDA0003077839410000026
参数自适应律
Figure FDA0003077839410000027
和参数自适应律
Figure FDA0003077839410000028
通过参数调节模块获得，参数自适应律
Figure FDA0003077839410000029
的导数
Figure FDA00030778394100000210
和参数自适应律
Figure FDA00030778394100000211
的导数
Figure FDA00030778394100000212
的表达式分别为：
Figure FDA00030778394100000213
Figure FDA00030778394100000214
机器人中间变量Ψ通过中间变量模块获得，机器人中间变量Ψ的表达式为：
Figure FDA00030778394100000215
k0、k1、k2、k3均表示控制参数；
Figure FDA00030778394100000216
为
Figure FDA00030778394100000217
的导数；
Figure FDA00030778394100000218
为vd的导数。
2.根据权利要求1所述的一种不确定轮式移动机器人的自适应轨迹跟踪控制电路，其特征在于，所述参数调节模块包括参数自适应率
Figure FDA00030778394100000219
电路和参数自适应率
Figure FDA00030778394100000220
电路，所述参数自适应率
Figure FDA00030778394100000221
电路包括乘法器E1、乘法器E2、同相加法运算单元C1、积分运算放大单元G1，信号e1和信号v对应输入到乘法器E1的两个输入端，信号e3和信号w对应输入到乘法器E2的两个输入端，乘法器E1的输出端和乘法器E2的输出端与同相加法运算单元C1的两个输入端连接，同相加法运算单元C1的输出端与积分运算放大单元G1的输入端连接，积分运算放大单元G1的输出端输出参数自适应率
Figure FDA0003077839410000031
参数自适应率
Figure FDA0003077839410000032
电路包括除法运算放大单元F1、乘法器E3、乘法器E4、反相运算放大单元A1、同相加法运算单元C2、除法运算放大单元F2、乘法器E5、反相加法运算单元B1、积分运算放大单元G2，除法运算放大单元F1的除数输入端输入参数自适应率
Figure FDA0003077839410000033
被除数输入端输入参数自适应率
Figure FDA0003077839410000034
除法运算放大单元F2除数输入端输入变量Ψ，被除数输入端输入参数自适应率
Figure FDA0003077839410000035
信号e1和信号v对应输入到乘法器E3两个输入端，信号e3和信号w对应输入到乘法器E4两个输入端，乘法器E3和乘法器E4的输出端对应与同相加法运算单元C2的两个输入端连接，除法运算放大单元F1的输出端、同相加法运算单元C2的输出端与乘法器E5的两个输入端对应连接，反相运算放大单元A1的输入端输入参数自适应率
Figure FDA0003077839410000036
除法运算放大单元F2的输出端、反相运算放大单元A1的输出端、乘法器E5的输出端分别对应连接反相加法运算单元B1的三个输入端，反相加法运算单元B1的输出端与积分运算放大单元G2的输入端连接，积分运算放大单元G2的输出端输出参数自适应率
Figure FDA0003077839410000037
乘法器E5的输出端输出信号M。
3.根据权利要求1所述的一种不确定轮式移动机器人的自适应轨迹跟踪控制电路，其特征在于，所述中间变量模块包括产生信号ζ的第一中间电路、产生变量
Figure FDA0003077839410000038
的第二中间电路、产生信号
Figure FDA0003077839410000039
的第三中间电路、获得信号w*的第四中间电路、获得变量Ψ的第五中间电路；
第一中间电路包括反相运算放大单元A9、积分运算放大单元G3，反相运算放大单元A9的输入端输入信号e2，反相运算放大单元A9的输出端与积分运算放大单元G3的输入端连接，积分运算放大单元G3的输出端输出信号ζ；
第二中间电路包括依次设置的反相运算放大单元A10和微分运算放大单元H1，反相运算放大单元A10输入端输入信号跟踪目标模块输出的信号vd，微分运算放大单元H1输出端输出信号
Figure FDA0003077839410000041
第三中间电路包括依次串联设置的反相运算放大单元A11、微分运算放大单元H2、反相运算放大单元A12、微分运算放大单元H3，反相运算放大单元A11输入端输入信号φd，微分运算放大单元H3输出端输出信号
Figure FDA0003077839410000042
微分运算放大单元H3输出端输出信号
Figure FDA0003077839410000043
第四中间电路包括反相运算放大单元A6、反相运算放大单元A7、反相运算放大单元A8，反相运算放大单元A6、反相运算放大单元A7、反相运算放大单元A8对应的输入端分别输入变量
Figure FDA0003077839410000044
信号e2、信号ζ，反相运算放大单元A6、反相运算放大单元A7、反相运算放大单元A8作为反相加法运算单元B2的三路输入信号，反相加法运算单元B2输出端输出信号w*；
第五中间电路包括反相运算放大单元A2、反相运算放大单元A3、反相运算放大单元A4、反相运算放大单元A5、同相加法运算单元C3、减法运算放大单元D1、减法运算放大单元D2、乘法器E6、乘法器E7、同相加法运算单元C4；反相运算放大单元A4、反相运算放大单元A2、反相运算放大单元A5的输入端对应输入信号e1、信号e2、信号e3，反相运算放大单元A3的输入端输入信号ζ，反相运算放大单元A2的输出端和反相运算放大单元A3的输出端对应连接同相加法运算单元C3的两个输入端，同相加法运算单元C3的另一个输入端输入信号
Figure FDA0003077839410000045
反相运算放大单元A5的输出端和同相加法运算单元C3的输出端对应连接到减法运算放大单元D1的减数输入端和被减数输入端，乘法器E6的两个输入端分别输入减法运算放大单元D1的输出端输出的信号和信号e3；反相运算放大单元A4的输出端连接到减法运算放大单元D2的减数输入端，信号
Figure FDA0003077839410000046
输入到减法运算放大单元D2的被减数输入端，乘法器E7的两个输入端分别输入信号e1和减法运算放大单元D2的输出端信号；乘法器E6的输出端和乘法器E7的输出端对应连接到同相加法运算单元C4的两个输入端，同相加法运算单元C4的输出端输出信号Ψ。
4.根据权利要求1所述的一种不确定轮式移动机器人的自适应轨迹跟踪控制电路，其特征在于，所述误差获取模块包括输出信号e1的第一误差电路、输出信号e2的第二误差电路、输出信号e3的第三误差电路，第一误差电路通过减法运算放大单元D3实现e1＝vd-v、第二误差电路通过减法运算单元实现e2＝φd-φ、第三误差电路通过减法运算单元实现e3＝ω*-ω；减法运算放大单元D3的减数输入端输入信号vd，被减数输入端输入信号v。
5.根据权利要求2所述的一种不确定轮式移动机器人的自适应轨迹跟踪控制电路，其特征在于，控制输入模块包括输出信号u1的第一控制电路、输出信号u2的第二控制电路；
第一控制电路包括反相运算放大单元A13、反相运算放大单元A14、减法运算放大单元D4、反相加法运算单元B3、乘法器E8、乘法器E9、除法运算放大单元F3，反相运算放大单元A13、反相运算放大单元A14输入端对应输入信号e1和信号e3，反相运算放大单元A13和反相运算放大单元A14输出端分别与反相加法运算单元B3的两个输入端连接，减法运算放大单元D4被减数输入端输入信号
Figure FDA0003077839410000051
减数输入端输入信号M，反相加法运算单元B3输出端与乘法器E8的两个输入端、乘法器E9的一个输入端连接，乘法器E9的另一个输入端与减法运算放大单元D4的输出端连接，乘法器E8与除法运算放大单元F3的除数输入端连接，乘法器E9与除法运算放大单元F3的被除数输入端连接，除法运算放大单元F3的输出端输出信号u1；
第二控制电路包括反相运算放大单元A15、反相运算放大单元A16、反相运算放大单元A17、减法运算放大单元D5、除法运算放大单元F4、除法运算放大单元F5、乘法器E10、乘法器E11，反相运算放大单元A15输入端输入信号e3，反相运算放大单元A15的输出端与反相运算放大单元A16的输入端连接，反相运算放大单元A16输出端与乘法器E10的两个输入端、乘法器E11的一个输入端连接，乘法器E10的输出端与反相运算放大单元A17的输入端连接；除法运算放大单元F4的被除数端输入信号Ψ，除数端输入信号
Figure FDA0003077839410000052
减法运算放大单元D5减数输入端与除法运算放大单元F4的输出端连接，被减数输入端输入信号
Figure FDA0003077839410000053
减法运算放大单元D5的输出端与乘法器E11的另一个输入端连接；乘法器E11的输出端与除法运算放大单元F5的除数端连接，反相运算放大单元A17的输出端与除法运算放大单元F5的被除数端连接，除法运算放大单元F5的输出端输出信号u2。
6.根据权利要求5所述的一种不确定轮式移动机器人的自适应轨迹跟踪控制电路，其特征在于，所述系统模型模块包括产生信号v的第一模型电路和产生信号φ和信号w的第二模型电路；
第一模型电路包括反相运算放大单元A18、反相运算放大单元A19、减法运算放大单元D6、积分运算放大单元G4，反相运算放大单元A18输入端的输入信号v，反相运算放大单元A19输入端的输入信号u1，反相运算放大单元A18、反相运算放大单元A19的输出端对应连接到减法运算放大单元D6的减数输入端、被减数输入端，减法运算放大单元D6的输出端与积分运算放大单元G4输入端连接，积分运算放大单元G4的输出端输出信号v，且反馈至反相运算放大单元A18的输入端；
第二模型电路包括反相运算放大单元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的输入端。
CN201810878267.9A 2018-08-03 2018-08-03 一种不确定轮式移动机器人的自适应轨迹跟踪控制电路 Active CN109062208B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810878267.9A CN109062208B (zh) 2018-08-03 2018-08-03 一种不确定轮式移动机器人的自适应轨迹跟踪控制电路

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810878267.9A CN109062208B (zh) 2018-08-03 2018-08-03 一种不确定轮式移动机器人的自适应轨迹跟踪控制电路

Publications (2)

Publication Number Publication Date
CN109062208A CN109062208A (zh) 2018-12-21
CN109062208B true CN109062208B (zh) 2021-08-10

Family

ID=64833073

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810878267.9A Active CN109062208B (zh) 2018-08-03 2018-08-03 一种不确定轮式移动机器人的自适应轨迹跟踪控制电路

Country Status (1)

Country Link
CN (1) CN109062208B (zh)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103926839A (zh) * 2014-04-23 2014-07-16 浙江师范大学 一种轮式移动机器人的运动分段控制方法
RU167531U1 (ru) * 2015-10-15 2017-01-10 Федеральное государственное автономное образовательное учреждение высшего образования "Уральский федеральный университет имени первого Президента России Б.Н. Ельцина" Мобильный наземный робот
CN107203141A (zh) * 2017-08-02 2017-09-26 合肥工业大学 一种机械臂分散化神经鲁棒控制的轨迹跟踪算法
CN107272677A (zh) * 2017-06-07 2017-10-20 东南大学 一种移动机器人的变结构自适应轨迹跟踪控制方法

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5268834A (en) * 1991-06-24 1993-12-07 Massachusetts Institute Of Technology Stable adaptive neural network controller
JP4488569B2 (ja) * 1999-12-22 2010-06-23 日本テキサス・インスツルメンツ株式会社 最短時間ｐｌｌ回路
EP2411972B1 (en) * 2009-03-26 2018-01-03 Ohio University Trajectory tracking flight controller
CN103595050B (zh) * 2013-11-22 2015-06-10 河海大学常州校区 模型参考自适应模糊控制的有源电力滤波器控制方法
CN104049534B (zh) * 2014-04-29 2017-01-25 河海大学常州校区 微陀螺仪的自适应迭代学习控制方法
CN104317299B (zh) * 2014-11-11 2017-01-25 东南大学 一种基于轮式移动机器人轨迹跟踪的混合控制方法
CN205380681U (zh) * 2016-01-27 2016-07-13 苏州宏奇锐自动化有限公司 一种扫地机器人智能滤波自适应行走机构
CN106549609B (zh) * 2016-10-24 2019-04-09 合肥工业大学 基于积分型高阶终端滑模算法的永磁同步电机控制方法
CN107482971B (zh) * 2017-09-14 2019-11-19 湖南工程学院 一种并网风力发电机控制器及其控制方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103926839A (zh) * 2014-04-23 2014-07-16 浙江师范大学 一种轮式移动机器人的运动分段控制方法
RU167531U1 (ru) * 2015-10-15 2017-01-10 Федеральное государственное автономное образовательное учреждение высшего образования "Уральский федеральный университет имени первого Президента России Б.Н. Ельцина" Мобильный наземный робот
CN107272677A (zh) * 2017-06-07 2017-10-20 东南大学 一种移动机器人的变结构自适应轨迹跟踪控制方法
CN107203141A (zh) * 2017-08-02 2017-09-26 合肥工业大学 一种机械臂分散化神经鲁棒控制的轨迹跟踪算法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
非完整约束轮式移动机器人运动控制系统研究;王鸣;《福建交通科技》;20111015(第05期);第62-65页 *

Also Published As

Publication number Publication date
CN109062208A (zh) 2018-12-21

Similar Documents

Publication Publication Date Title
CN108897224B (zh) 一种不确定轮式移动机器人的自适应轨迹跟踪控制方法
CN110221539B (zh) 基于线性扩张观测器的四旋翼非奇异终端滑模控制方法
CN106125728B (zh) 一种四驱轮式移动机器人轨迹跟踪控制方法
Asif et al. Adaptive sliding mode dynamic controller with integrator in the loop for nonholonomic wheeled mobile robot trajectory tracking
Chen et al. Design and implementation of an adaptive sliding-mode dynamic controller for wheeled mobile robots
CN108646758A (zh) 一种多移动机器人预设性能编队控制器结构及设计方法
CN105549383B (zh) 直线电机精密轨迹跟踪装置及方法
CN112666833B (zh) 一种用于电动自动驾驶车辆的车速跟随自适应鲁棒控制方法
JPH0740204B2 (ja) 多自由度非線形機械システムの制御装置
CN107168369A (zh) 一种欠驱动无人车的编队控制方法及系统
CN106113046B (zh) 基于死区和摩擦补偿的机械臂伺服系统动态面瞬态控制方法
CN108829123A (zh) 一种四旋翼飞行器控制方法、系统和装置
CN114815618B (zh) 一种基于动态增益的自适应神经网络跟踪控制方法
CN109062208B (zh) 一种不确定轮式移动机器人的自适应轨迹跟踪控制电路
Rigatos A nonlinear optimal control approach for tracked mobile robots
CN112198888A (zh) 一种考虑无人机在机动平台自主起降的自适应pid控制方法
Yuan et al. Differential flatness-based adaptive robust tracking control for wheeled mobile robots with slippage disturbances
Mazur Hybrid adaptive control laws solving a path following problem for non-holonomic mobile manipulators
CN112757299B (zh) 质心轨迹的获取方法、装置、机器人及存储介质
CN110389525B (zh) 基于极限学习机的混联机构自适应反步控制方法
CN107263455B (zh) 二自由度scara机器人的位置跟踪控制方法
Jian et al. The sliding mode control based on extended state observer for skid steering of 4-wheel-drive electric vehicle
CN205427466U (zh) 直线电机精密轨迹跟踪装置
CN109032163B (zh) 一种考虑电机电压的四旋翼飞行器姿态控制方法
CN114690754A (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
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20220112

Address after: 230001 floor 6, block B, blue diamond Shangjie, No. 335, Suixi Road, Bozhou road street, Luyang District, Hefei City, Anhui Province

Patentee after: Hefei Luyang Technology Innovation Group Co.,Ltd.

Address before: 230009 No. 193, Tunxi Road, Hefei, Anhui

Patentee before: Hefei University of Technology