多模态鲁棒自抗扰运动控制方法及系统

1.本发明涉及运动控制技术领域，尤其涉及一种多模态鲁棒自抗扰运动控制方法及系统。


背景技术：

2.运动控制技术在当今工业中应用广泛，如电机运动控制、数控机床、机器人控制等。运动控制是指对位置/位移、速度、加速度等运动量进行控制。采用电动机作为运动执行器，相比其它类型的运动执行器，具有结构简单、响应快、精度和效率高等优点，有利于实现高速或低速、高精度等高性能运动控制，在现代工业、民用、医疗、交通和军事等领域具有广泛的应用前景。
3.由于运动控制系统存在摩擦力、系统参数变化、负载扰动力等因素影响，尤其是系统非线性因素(如信号测量噪声)和不确定干扰，很大程度上影响系统的运动精度。因此对运动控制器的性能提出了很高的要求。
4.目前，有越来越多的先进控制算法被运用到运动控制研究中，常见的有迭代学习控制算法、自适应鲁棒控制算法、神经网络控制算法和自抗扰控制算法等，其中自抗扰控制被公认为较为有效的技术。
5.现有技术中中国发明专利“一种基于可调阶次滤波器的分数阶自抗扰运动控制方法”（公告号cn108459507b，2021年05月25日）提出了一种具有参数调节灵活、易于工程实现的运动控制方法，并有效改善了运动控制系统对测量噪声和干扰的抑制能力，但其针对的模型相对简单，且未考虑多模态特性。
6.现有技术中中国发明专利“一种用于飞行器多模态控制系统的设计方法”（公告号cn104573182b，2017年12月08日）提出了一种用于飞行器多模态控制系统的设计方法，能够对系统进行功能、物理、软件体系结构进行定义和分析，但对于具体的控制器设计并未详细给出。
7.论文“adaptive tracking control for a class of uncertain switched nonlinear systems”（zhao x, zheng x, niu b, et al. adaptive tracking control for a class of uncertain switched nonlinear systems[j]. automatica, 2015, 2:185-191.）针对一类具有未知函数的切换非线性系统控制问题，采用自适应反步技术构造状态反馈控制器，并利用李雅普诺夫函数证明了其稳定性。所设计的状态反馈控制器可以确保所有信号有界，并且跟踪误差收敛到原点的一个小邻域，但其控制器设计未对系统扰动进行处理，并且在模态切换时，被控对象的瞬态响应可能产生突变，消耗较多能源，同时可能损害系统执行机构。
[0008]
然而，相关技术中的自抗扰运动控制方法未考虑较为复杂且具有实际工程意义的系统多模态特性，难以抑制执行机构的瞬态响应突变，即存在模态切换时控制指令的突变而导致的闭环系统稳定性降低，系统的控制精度降低的问题。


技术实现要素：

[0009]
有鉴于此，本发明提供一种多模态鲁棒自抗扰运动控制方法，实现多模态系统的控制，提高了控制精度以及被控系统的稳定性，使得多模态被控系统具有较强的鲁棒性。
[0010]
本发明首先提供了一种多模态鲁棒自抗扰运动控制方法，所述方法包括依次执行的如下步骤：根据被控系统信息，判断被控系统当前所处的控制模态；其中，所述被控系统信息包括被控系统的状态信息；根据所述被控系统当前所处的控制模态，确定与所述被控系统当前所处的控制模态对应的理想控制指令；根据所述被控系统信息和所述理想控制指令，确定所述被控系统的实际控制指令。
[0011]
在一种可能的实施方式中，所述方法还包括：根据所述被控系统的控制目标，建立多模态的被控系统模型；根据所述被控系统模型和所述被控系统的控制目标，确定被控系统的控制模态。
[0012]
在一种可能的实施方式中，所述方法还包括：建立控制器模型和扰动观测器模型；其中，所述控制模态对应不同的控制模型和扰动观测器模型；其中，所述扰动观测器模型，用于估计所述被控系统的扰动参数；所述控制器模型，用于根据所述被控系统模型和所述扰动参数确定与所述被控系统当前所处的控制模态对应的理想控制指令。
[0013]
在一种可能的实施方式中，所述根据所述被控系统信息和所述理想控制指令，确定所述被控系统的实际控制指令，包括：根据所述理想控制指令和前一控制模态对应的实际控制指令对所述理想控制指令进行修正，得到修正后的实际控制指令。
[0014]
在一种可能的实施方式中，根据所述被控系统的控制目标，建立多模态的被控系统模型，包括：建立如下所述被控系统模型：其中，表示所述被控系统模型包括个动态方程表示所述被控系统模型包括个不同的模态；表示状态信息的一阶导数；表示被控系统的状态信息构成的状态信息向量；表示根据所述状态信息向量，利用径向基函数神经网络算法rbfnn得到的系统状态向量的连续函数；表示状态信息对应的扰动参数；表示第个模态下的控制输入，所述控制方法的实际指令；和表示所述被控系统的状态输出。
[0015]
在一种可能的实施方式中，所述建立控制器模型和扰动观测器模型，包括：针对所述被控系统模型，设计第个模态对应的鲁棒自抗扰运动控制器；对于时，建立如下扰动观测器模型：建立如下控制器模型：其中，表示被控系统模型中第一个动态方程对应的控制指令，为参考信号，表示被控系统的控制目标，跟踪误差表示为是扰动观测器针对状态信息估计的扰动参数，是观测误差，假设，是观测误差上界的估计值，的一阶导数，是双曲正切函数；参数是双曲正切函数；参数均为扰动观测器模型设计过程中可调节的参数，为扰动观测器模型设计过程中的中间量，没有实际物理意义。
[0016]
在一种可能的实施方式中，所述建立控制器模型和扰动观测器模型，包括：对于时，建立如下扰动观测器模型：建立如下控制器模型：其中，表示被控系统模型中第个动态方程对应的控制指令，跟踪误差表示为是扰动观测器针对状态信息估计的扰动参数，是观测误差，假设是观测误差上界的估计值，的一阶导数，是双曲正切函数；是双曲正切函数；均为扰动观测器及控制器模型设计过程中可调节的
参数，为扰动观测器模型设计过程中的中间量，没有实际物理意义。
[0017]
在一种可能的实施方式中，所述建立控制器模型和扰动观测器模型，包括：对于时，建立如下扰动观测器模型：建立如下控制器模型：其中，表示被控系统模型中第个动态方程对应的理想控制指令，跟踪误差表示为，是扰动观测器针对状态信息估计的扰动参数，是观测误差，假设，为切换误差，表示理想控制指令与实际控制指令之间的差值，为实际控制指令，的估计值，参数的估计值，参数均为扰动观测器及控制器模型设计过程中可调节的参数，为扰动观测器模型设计过程中的中间量，没有实际物理意义。
[0018]
在一种可能的实施方式中，所述根据所述被控系统信息和所述理想控制指令，确定所述被控系统的实际控制指令，包括：当所述切换误差的绝对值在小于等于第一阈值时，将所述理想控制指令作为实际控制指令；当所述切换误差的绝对值在大于第一阈值时，对所述理想控制指令进行修正，得到实际控制指令。
[0019]
在一种可能的实施方式中，所述当所述切换误差的绝对值在小于等于第一阈值时，将所述理想控制指令作为实际控制指令，当所述切换误差的绝对值在大于第一阈值时，对所述理想控制指令进行修正，得到实际控制指令，包括：其中为可调节的正参数。
[0020]
本发明还提供了一种多模态鲁棒自抗扰运动控制系统，所述系统用于执行所述控制方法，所述系统包括：控制模态判断模块，用于根据被控系统信息，判断被控系统当前所处的控制模态；其中，所述被控系统信息包括被控系统的状态信息；理想控制指令确定模块，用于根据所述被控系统当前所处的控制模态，确定与所述被控系统当前所处的控制模态对应的理想控制指令；指令修正模块，用于根据所述被控系统信息和所述理想控制指令，确定所述被控系统的实际控制指令。
[0021]
在一种可能的实施方式中，所述多模态鲁棒自抗扰运动控制系统，还包括：被控系统模型建立模块，用于根据所述被控系统的控制目标，建立多模态的被控系统模型；根据所
述被控系统模型和所述被控系统的控制目标，确定被控系统的控制模态。
[0022]
在一种可能的实施方式中，所述多模态鲁棒自抗扰运动控制系统，还包括：控制器模型和扰动观测器模型建立模块，用于建立控制器模型和扰动观测器模型；其中，所述控制模态对应不同的控制模型和扰动观测器模型；其中，所述扰动观测器模型，用于估计所述被控系统的扰动参数；所述控制器模型，用于根据所述被控系统模型和所述扰动参数确定与所述被控系统当前所处的控制模态对应的理想控制指令。
[0023]
在一种可能的实施方式中，所述指令修正模块，还用于根据所述理想控制指令和前一控制模态对应的实际控制指令对所述理想控制指令进行修正，得到修正后的实际控制指令。
[0024]
本发明的多模态鲁棒自抗扰运动控制方法，可以根据被控系统信息，判断被控系统当前所处的控制模态，根据所述被控系统当前所处的控制模态，确定与所述被控系统当前所处的控制模态对应的理想控制指令；根据所述被控系统信息和所述理想控制指令，确定所述被控系统的实际控制指令。所述控制方法能够实现对理想控制指令的修正得到实际控制指令，抑制不同模态控制规律转换时被控系统的瞬态响应，实现多模态系统的控制，提高了控制精度以及被控系统的稳定性，使得多模态被控系统具有较强的鲁棒性。
[0025]
根据下面参考附图对示例性实施例的详细说明，本发明的其它特征及方面将变得清楚。
附图说明
[0026]
为了更清楚地说明本发明实施例的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其它的附图。
[0027]
图1示出本发明一实施例的一种多模态鲁棒自抗扰运动控制方法的示意图。
[0028]
图2示出本发明一实施例的一种多模态鲁棒自抗扰运动控制方法的流程图。
[0029]
图3示出本发明另一实施例的一种多模态鲁棒自抗扰运动控制方法的流程图。
[0030]
图4示出本发明一实施例的鲁棒自抗扰控制器控制被控系统的示意图。
具体实施方式
[0031]
下面结合附图对本发明实施例进行详细描述。
[0032]
需说明的是，在不冲突的情况下，以下实施例及实施例中的特征可以相互组合；并且，基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
[0033]
需要说明的是，下文描述在所附权利要求书的范围内的实施例的各种方面。应显而易见，本文中所描述的方面可体现于广泛多种形式中，且本文中所描述的任何特定结构及/或功能仅为说明性的。基于本发明，所属领域的技术人员应了解，本文中所描述的一个方面可与任何其它方面独立地实施，且可以各种方式组合这些方面中的两者或两者以上。举例来说，可使用本文中所阐述的任何数目个方面来实施设备及/或实践方法。另外，可使用除了本文中所阐述的方面中的一或多者之外的其它结构及/或功能性实施此设备及/或实践此方法。
[0034]
图1示出本发明一实施例的一种多模态鲁棒自抗扰运动控制方法的示意图。
[0035]
如图1所示，被控对象的执行机构可以向被控对象反馈执行机构的运动状态，传感器可以获取被控对象的状态信息。鲁棒自抗扰控制器，可以根据控制的目标和相关控制理论，构造标称控制器，利用非线性扰动观测器估计系统的未知扰动，并对标称控制器进行补偿得可以实现自抗扰的鲁棒自抗扰控制器。所述多模态鲁棒自抗扰运动控制方法中可以包括多模态切换机制，该机制可以实现根据传感器获取的被控对象的状态信息，判断出被控对象当前所处的模态。所述多模态鲁棒自抗扰运动控制方法中也可以多模态条件下的事件触发机制，该机制可以实现根据传感器获取的被控对象的状态信息确定当前状态对应的理想控制指令，鲁棒自抗扰控制器可以根据所述理想控制指令和前一控制模态对应的实际控制指令对所述理想控制指令进行修正，得到修正后的实际控制指令，将其通过控制网络传递给执行机构，进而实现对被控对象的运动控制，保证了执行机构在一定的阈值内不发生突变，即抑制不同控制模态转换时被控系统的瞬态响应。图2示出本发明一实施例的一种多模态鲁棒自抗扰运动控制方法的流程图。
[0036]
所述方法包括依次执行的如下步骤：步骤s1：根据被控系统信息，判断被控系统当前所处的控制模态；其中，所述被控系统信息包括被控系统的状态信息；步骤s2：根据所述被控系统当前所处的控制模态，确定与所述被控系统当前所处的控制模态对应的理想控制指令；步骤s3：根据所述被控系统信息和所述理想控制指令，确定所述被控系统的实际控制指令。
[0037]
通过判断被控系统当前所处的控制模态，根据所述被控系统当前所处的控制模态，确定与所述被控系统当前所处的控制模态对应的理想控制指令；根据所述被控系统信息和所述理想控制指令，确定所述被控系统的实际控制指令。所述控制方法能够实现对理想控制指令的修正得到实际控制指令，抑制不同模态控制规律转换时被系统的瞬态响应，实现多模态系统的控制，提高了控制精度以及被控系统的稳定性，使得多模态被控系统具有较强的鲁棒性。
[0038]
在另一种可能的实施方式中，如图3所示，在步骤s1之前，还可以包括步骤s0。
[0039]
步骤s0包括：根据所述被控系统的控制目标，建立多模态的被控系统模型；根据所述被控系统模型和所述被控系统的控制目标，确定被控系统的控制模态；建立控制器模型和扰动观测器模型；其中，所述控制模态对应不同的控制模型和扰动观测器模型；其中，所述扰动观测器模型，用于估计所述被控系统的扰动参数；所述控制器模型，用于根据所述被控系统模型和所述扰动参数确定与所述被控系统当前所处的控制模态对应的理想控制指令。
[0040]
在一种可能的实施方式中，根据所述被控系统的控制目标，建立多模态的被控系统模型，包括：建立如下所述被控系统模型：
其中表示所述被控系统模型包括个动态方程；表示所述被控系统模型包括个不同的模态；表示状态信息的一阶导数；表示被控系统的状态信息构成的状态信息向量；表示根据所述状态信息向量，利用径向基函数神经网络算法rbfnn得到的系统状态向量的连续函数；表示状态信息对应的扰动参数；表示第个模态下的控制输入，所述控制方法的实际指令；和表示所述被控系统的状态输出。
[0041]
在一种可能的实施方式中，例如所述被控系统可以是无人机系统，机器人系统，机械臂系统等存在运动控制的系统。例如针对无人机被控系统，可以根据无人机系统的垂直上升，水平匀速飞行，水平加速飞行，水平减速飞行，垂直下降等控制目标，确定无人机系统的多个控制模态：垂直上升模态，水平匀速飞行模态，水平加速飞行模态，水平减速飞行模态，垂直下降模态。可以根据无人机的所述多个控制目标建立无人机的多模态的被控系统模型。
[0042]
在一种可能的实施方式中，所述被控系统是无人机系统时，通过实际的飞行实验，获取足够多的飞行状态信息得到被控系统的状态信息构成的状态信息向量，以及获取足够多的飞机控制输入数据（或称控制指令）。例如，无人机系统的飞行状态信息包括速度，加速度，角速度等。根据所述状态信息向量，利用径向基函数神经网络（radial basis function neural network，rbfnn）算法，得到的被控系统状态向量的拟合函数表达式，建立不同模态下的拟合函数数据库，根据所述函数构建被控系统模型。在一种可能的实施方式中，将被控系统状态向量的函数存入数据库中，为后续控制器模型设计做准备。
[0043]
通过实验获取大量的被控系统的运动控制数据，得到被控系统的状态信息构成的状态信息向量以及控制输入数据。根据所述状态信息向量，利用径向基函数神经网络rbfnn算法，得到的被控系统状态向量的函数，从而建立多模态包括系统模型。这样，通过建立多模态被控系统解决了相关技术中设计的被控系统模型相对简单，未考虑较为复杂且具有实际工程意义的系统多模态特性，当模态切换时，被控系统的稳定性不好，控制精度不高的技
术问题。
[0044]
多模态控制系统模型建立过程中使用的rbfnn算法是本领域中常用的具有较好的逼近性能的算法，广泛应用于模式识别、非线性函数逼近等领域的神经网络模型。本发明对根据状态信息向量，利用径向基函数神经网络得到被控系统状态向量的函数和的具体实现方式不做限定。
[0045]
在一种可能的实施方式中，所述建立控制器模型和扰动观测器模型，包括：针对所述被控系统模型，设计第个模态对应的鲁棒自抗扰运动控制器；对于时，建立如下扰动观测器模型：建立如下控制器模型：其中，表示被控系统模型中第一个动态方程对应的控制指令，为参考信号，表示被控系统的控制目标，跟踪误差表示为是扰动观测器针对状态信息估计的扰动参数，是观测误差，假设是观测误差上界的估计值，是的一阶导数，是双曲正切函数；参数是双曲正切函数；参数均为扰动观测器及控制器模型设计过程中可调节的参数，为扰动观测器模型设计过程中的中间量，没有实际物理意义。
[0046]
其中，上述扰动观测器模型和控制器模型中的被控系统状态向量的函数可以从前述拟合函数数据库中直接获取，本发明对此不进行特殊限定。
[0047]
在一种可能的实施方式中，所述建立控制器模型和扰动观测器模型，包括：对于时，建立如下扰动观测器模型：建立如下控制器模型：
其中，表示被控系统模型中第i个动态方程对应的控制指令，跟踪误差表示为是扰动观测器针对状态信息估计的扰动参数，是观测误差，假设是观测误差上界的估计值，是的一阶导数，是双曲正切函数；均为扰动观测器及控制器模型设计过程中可调节的参数，为扰动观测器模型设计过程中的中间量，没有实际物理意义。
[0048]
在一种可能的实施方式中，所述建立控制器模型和扰动观测器模型，包括：对于时，建立如下扰动观测器模型：建立如下控制器模型：其中，表示被控系统模型中第个动态方程对应的理想控制指令，跟踪误差表示为是扰动观测器针对状态信息估计的扰动参数，是观测误差，假设为切换误差，表示理想控制指令与实际控制指令之间的差值，为实际控制指令，是的估计值，参数是的估计值，参数均为扰动观测器及控制器模型设计过程中可调节的参数，为扰动观测器模型设计过程中的中间量，没有实际物理意义。
[0049]
这样，针对已经建立的多模态被控系统，设计出控制器模型和扰动观测器模型，解决了相关技术中仅对控制器的软件系统结构的定义，但对于具体的控制器设计并未详细给出的技术问题。
[0050]
在一种可能的实施方式中，根据被控系统模型中建立的不同模态下系统状态向量的拟合函数数据库。设计多模态切换机制，当系统状态信息改变时，步骤s1中根据被控系统信息，判断被控系统当前所处的控制模态，即启动当前所处对应模态的控制器，然后所述控制器来确定与与所述被控系统当前所处的控制模态对应的理想控制指令。
[0051]
这样，不同的控制模态对应于不同的控制器，提高了控制器输出的控制指令的准确性，进而提高了控制精度。而且，控制器的设计中考虑了模态切换时，被控系统的瞬态响应可能产生突变的扰动，对系统扰动进行观测估计，解决了由于存在扰动而导致的系统消耗较多能源，同时可能损害系统执行机构的技术问题。
[0052]
在一种可能的实施方式中，所述根据所述被控系统信息和所述理想控制指令，确定所述被控系统的实际控制指令，可以包括：根据所述理想控制指令和前一控制模态对应的实际控制指令对所述理想控制指令进行修正，得到修正后的实际控制指令。
[0053]
在一种可能的实施方式中，所述根据所述被控系统信息和所述理想控制指令，确定所述被控系统的实际控制指令，可以包括：当所述切换误差的绝对值在小于等于第一阈值时，将所述理想控制指令作为实际控制指令；当所述切换误差的绝对值在大于第一阈值时，对所述理想控制指令进行修正，得到实际控制指令。
[0054]
在一种可能的实施方式中，所述当所述切换误差的绝对值在小于等于第一阈值时，将所述理想控制指令作为实际控制指令，当所述切换误差的绝对值在大于第一阈值时，对所述理想控制指令进行修正，得到实际控制指令，包括：其中为可调节的正参数。
[0055]
这样，当所述切换误差的绝对值在小于等于第一阈值时，将所述理想控制指令作为实际控制指令；当所述切换误差的绝对值在大于第一阈值时，对所述理想控制指令进行修正，得到实际控制指令。抑制不同控制模态转换时被控系统的瞬态响应。当被控系统发生模态切换时，对控制器即将输入到包括系统的理想控制指令进行修正处理，具体而言是针对给定的第一阈值条件设置事件触发机制，保证执行器在一定阈值内不会发生突变。
[0056]
在一种可能的实施方式中，设置第一阈值为其中，为前一控制模态对应的控制指令，为在实验中可调节的适应对应的控制系统的正参数。本发明不对进行特殊限定。中的为前一控制模态对应的控制指令，该式表示对前一控制模态对应的实际控制指令和当前控制模态对应的理想控制指令进行加权后得到当前控制模态对应的实际控制指令，该实际控制指令即是修正后的控制指令。
[0057]
在一种可能的实施方式中，控制器中设置有事件触发机制，当控制器中的事件触发机制监测到当前控制模态对应的理想控制指令和控制模态切换之前的实际的控制指令相差过大时，开启指令修正机制，即对所述理想控制指令进行修正，得到实际输入到被控系统的实际控制指令，保证执行器在一定阈值内不会发生突变，即抑制不同控制模态转换时被控系统的瞬态响应。
[0058]
图4示出本发明一实施例的鲁棒自抗扰控制器控制被控系统的示意图。在一种可能的实施方式中，根据无人机系统的控制目标，建立多模态的被控系统模型。例如，无人机
系统包括垂直地面上升，水平匀速飞行，水平加速飞行，水平减速飞行，垂直地面下降等控制目标，根据所述多个控制目标建立无人机系统的多模态控制模型。根据所述无人机系统模型和所述无人机系统的控制目标，确定被控系统的多个控制模态，例如无人机系统的水平匀速控制模态，加速上升控制模态，减速下降控制模态等控制模态。
[0059]
如图4所示，被控系统中包括传感器和执行机构，所述传感器用于感测被控系统的状态信息。举例来说，当被控系统为无人机系统时，传感器可以感测无人机系统的高度，速度，加速度，角速度等信息；所述执行机构可以是电动机，用于驱动无人机的运动。所述无人机系统包括鲁棒自抗扰控制器和被控系统。图4中的鲁棒自抗扰控制器可以获取被控系统中传感器感测到的被控系统的状态信息，根据该状态系信息判断被控系统当前所处的控制模态，例如所述鲁棒自抗扰控制器判断出无人机系统处于垂直于地面加速上升的控制模态，确定与所述被控系统当前所处的加速上升控制模态对应的理想控制指令；根据所述被控系统信息和所述理想控制指令，确定所述被控系统的实际控制指令。
[0060]
在一种可能的实施方式中，图4中的鲁棒自抗扰控制器可以根据所述理想控制指令和前一控制模态对应的实际控制指令对所述理想控制指令进行修正，得到修正后的实际控制指令。例如，当鲁棒自抗扰控制器中的事件触发机制检测到当前控制模态（加速上升控制模态）对应的理想控制指令和控制模态切换之前的控制模态（例如匀速水平飞行）对应的实际的控制指令相差过大时（即大于一定的阈值），开启指令修正机制，即对所述理想控制指进型修正，得到实际输入到被控系统的实际控制指令，保证了执行机构在一定的阈值内不发生突变，即抑制不同控制模态转换时被控系统的瞬态响应。
[0061]
本发明还提供了一种多模态鲁棒自抗扰运动控制系统，所述系统用于执行所述控制方法，所述系统包括：控制模态判断模块，用于根据被控系统信息，判断被控系统当前所处的控制模态；其中，所述被控系统信息包括被控系统的状态信息；理想控制指令确定模块，用于根据所述被控系统当前所处的控制模态，确定与所述被控系统当前所处的控制模态对应的理想控制指令；指令修正模块，用于根据所述被控系统信息和所述理想控制指令，确定所述被控系统的实际控制指令。
[0062]
在一种可能的实施方式中，所述多模态鲁棒自抗扰运动控制系统，还包括：被控系统模型建立模块，用于根据所述被控系统的控制目标，建立多模态的被控系统模型；根据所述被控系统模型和所述被控系统的控制目标，确定被控系统的控制模态。
[0063]
在一种可能的实施方式中，所述多模态鲁棒自抗扰运动控制系统，还包括：控制器模型建立模块，用于建立控制器模型和扰动观测器模型；其中，所述控制模态对应不同的控制模型和扰动观测器模型；其中，所述扰动观测器模型，用于估计所述被控系统的扰动参数；所述控制器模型，用于根据所述被控系统模型和所述扰动参数确定与所述被控系统当前所处的控制模态对应的理想控制指令。在一种可能的实施方式中，所述指令修正模块，还用于根据所述理想控制指令和前一控制模态对应的实际控制指令对所述理想控制指令进行修正，得到修正后的实际控制指令。
[0064]
根据本发明的多模态鲁棒自抗扰运动控制方法，可以根据被控系统信息，判断被控系统当前所处的控制模态，根据所述被控系统当前所处的控制模态，确定与所述被控系统当前所处的控制模态对应的理想控制指令；根据所述被控系统信息和所述理想控制指令，确定所述被控系统的实际控制指令。所述控制方法能够实现多模态系统的控制，抑制不
同模态控制规律转换时被控系统的瞬态响应，提高了控制精度以及被控系统的稳定性，使得多模态被控系统具有较强的鲁棒性。
[0065]
以上所述，仅为本发明的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，可轻易想到的变化或替换，都应涵盖在本发明的保护范围之内。因此，本发明的保护范围应以权利要求的保护范围为准。