CN110906782B - 参数未知的链式自动化弹仓输入死区的控制方法及系统 - Google Patents
参数未知的链式自动化弹仓输入死区的控制方法及系统 Download PDFInfo
- Publication number
- CN110906782B CN110906782B CN201911274588.9A CN201911274588A CN110906782B CN 110906782 B CN110906782 B CN 110906782B CN 201911274588 A CN201911274588 A CN 201911274588A CN 110906782 B CN110906782 B CN 110906782B
- Authority
- CN
- China
- Prior art keywords
- chain type
- type automatic
- unknown
- unknown parameters
- magazine
- 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.)
- Expired - Fee Related
Links
Images
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F41—WEAPONS
- F41A—FUNCTIONAL FEATURES OR DETAILS COMMON TO BOTH SMALLARMS AND ORDNANCE, e.g. CANNONS; MOUNTINGS FOR SMALLARMS OR ORDNANCE
- F41A9/00—Feeding or loading of ammunition; Magazines; Guiding means for the extracting of cartridges
- F41A9/01—Feeding of unbelted ammunition
- F41A9/04—Feeding of unbelted ammunition using endless-chain belts carrying a plurality of ammunition
Landscapes
- Engineering & Computer Science (AREA)
- General Engineering & Computer Science (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了参数未知的链式自动化弹仓输入死区的控制方法及系统,包括:建立参数未知的链式自动化弹仓的数学模型;借助反步协议方法,设计虚拟控制力矩;通过一阶滑膜微分器对虚拟控制力矩的导数进行估计处理;利用自适应的方法对模型中未知参数及扰动的相关量进行估计处理,借助双曲函数设计最终的控制力矩。将一阶滑膜微分器与反步协议结合的方法首次应用到参数未知的链式自动化弹仓输入死区的控制中,保证了参数未知的链式自动化弹仓输入死区的稳定性,提高了参数未知的链式自动化弹仓控制的安全性。
Description
技术领域
本发明属于控制技术领域,尤其涉及参数未知的链式自动化弹仓输入死区的控制方法。
背景技术
本部分的陈述仅仅是提供了与本公开相关的背景技术信息,不必然构成在先技术。
已知自动填充装置可以大幅提高火炮在各种作战条件下的射速,而储弹弹仓是火炮自动装填系统中极为重要的组成部分,因此对自动化弹仓的研究得到了广泛的关注。
本公开所针对的自动化弹仓是一种参数未知的链式回转弹仓,其包括储弹筒、传动齿轮、传动链条等结构,主要完成弹丸的存放、回转选弹等工作。
实际应用中,只知链式弹仓的内部结构原理,其相应参数未知或因长时间工作而导致相应参数大小改变的情况时常发生,因此参数未知的链式回转弹仓的研究极具价值;而当弹仓工作时,其各部分的工作容易受环境条件等因素的影响将产生摩擦力矩、震动等线性或非线性的扰动,并且链式传动结构本身的多边形效应和齿轮齿条之间的啮合与冲击也将产生扰动,因此参数未知带扰动的链式回转弹仓的研究一直备受关注。摩擦等情况都可以建模到输入死区模型中,因此输入死区参数未知链式回转弹仓的研究极具价值,但是目前的相关成果中并没有涉及此方面的研究,故此问题亟待解决。
发明内容
为克服上述现有技术的不足,本发明提供了参数未知的链式自动化弹仓输入死区的控制方法,基于反步协议和一阶滑模微分器来实现参数未知的链式自动化弹仓输入死区的控制。
为实现上述目的,本发明的一个或多个实施例提供了如下技术方案:
参数未知的链式自动化弹仓输入死区的控制方法,包括:
建立参数未知的链式自动化弹仓的数学模型;
借助反步协议方法,设计虚拟控制力矩;
通过一阶滑膜微分器对虚拟控制力矩的导数进行估计处理;
利用自适应估计对模型中未知参数及扰动的相关量进行处理,借助双曲函数设计最终的控制力矩。
进一步的技术方案,链式自动化弹仓的动态模型方程为:
其中:M代表系统等效到电机输出轴的未知转动惯量;D代表系统等效到电机输出轴的未知黏性阻尼系数;q为电机转子位移;Td代表等效扰动;u代表实际控制输入力矩。
进一步的技术方案,利用控制输入死区的表达式,将弹仓模型进一步表示为以下等效的无量纲化数学形式:
其中:x1=q、为系统状态;设为系统总体的未知有效扰动,d(t)为死区产生的控制误差;表示未知参数,m为死区系数;v(t)为控制设计力矩;并且根据实际情况x1是电机转子位移,其工程上是可测的,因此为系统的输出信号。
工程中,链式弹仓的设计目标为:设计力矩(v)使得系统电机转子位移(q)能够在力矩的作用之下有界接近期望的位移(r)。现实应用中,链式弹仓的内部参数会出现未知的现象,并且设计力矩(v)往往会发生死区情况,因此需要考虑设计力矩发生死区情况下如何利用自身系统相关信息实现设计目标,进而提出了本方案中的控制方法。在建模时就已将链式弹仓的相关信息进行量化,因而在本设计方案中力矩(v)的设计即可借用系统量化信息(系统等效到电机输出轴的未知转动惯量、系统等效到电机输出轴的未知黏性阻尼系数)的估计量来设计对弹仓输出量(即电机转子位移q)的有效控制,最终将实际效果与期望的控制目标(r)之间的差值控制在一定范围之内的效果。
进一步的技术方案,应用反步协议引入坐标变换,选择李雅普诺夫预备函数,构造虚拟控制力矩。
进一步的技术方案,利用一阶滑膜微分器对虚拟控制力矩的导数进行估计处理,通过调节滑膜微分器中的参数,及其两个系统状态的初始值的大小,将虚拟控制力矩的导数做有效估计。
进一步的技术方案,再次利用反步协议方法构造李雅普诺夫函数,设计出最终的控制力矩:
对李雅普诺夫函数V求导可得其导数满足:
其中:k、Δ均代替相关参数。
本发明还公开了参数未知的链式自动化弹仓输入死区的控制系统,包括力矩及链式自动化弹仓,力矩控制链式自动化弹仓工作,所述控制力矩被配置通过下述方式实现:
建立参数未知的链式自动化弹仓的数学模型;
借助反步协议方法,设计虚拟控制力矩;
通过一阶滑膜微分器对虚拟控制力矩的导数进行估计处理;
利用自适应估计对模型中未知参数及扰动的相关量进行处理,借助双曲函数设计最终的控制力矩。
以上一个或多个技术方案存在以下有益效果:
(1)系统参数设为未知情况,有效的增强了研究对象的普适性。
(2)降低了追踪目标的要求,只需其一阶导数存在且有界即可,并不需要其导数的显示形式。
(3)一阶滑膜微分器的应用避免了反步协议中设计的虚拟控制力矩求导步骤困难的产生。
(4)首次将双曲函数tanh(x)应用到参数未知的链式自动化弹仓输入死区的稳定控制中,有效的提高了追踪误差的精确度。
(5)将一阶滑膜微分器与反步协议结合的方法首次应用到参数未知的链式自动化弹仓输入死区的控制中,保证了参数未知的链式自动化弹仓输入死区的稳定性,提高了参数未知的链式自动化弹仓控制的安全性。
附图说明
构成本发明的一部分的说明书附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。
图1为本公开实施例子未知的链式自动化弹仓的原理结构图;
图2为本公开实施例子的追踪误差图;
图3为本公开实施例子的设计输入v(t)与实际输入u(t);
图4为本公开实施例子的一阶滑膜微分器的估计误差图;
图5为本公开实施例子的模型中未知参数相关量的自适应估计图;
图6为本公开实施例子的流程图。
具体实施方式
应该指出,以下详细说明都是示例性的,旨在对本发明提供进一步的说明。除非另有指明,本文使用的所有技术和科学术语具有与本发明所属技术领域的普通技术人员通常理解的相同含义。
需要注意的是,这里所使用的术语仅是为了描述具体实施方式,而非意图限制根据本发明的示例性实施方式。如在这里所使用的,除非上下文另外明确指出,否则单数形式也意图包括复数形式,此外,还应当理解的是,当在本说明书中使用术语“包含”和/或“包括”时,其指明存在特征、步骤、操作、器件、组件和/或它们的组合。
在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。
本发明提出的总体思路:
参见附图6所示,首先根据链式自动化弹仓的内部运行机理,建立其数学模型;其次根据反步协议方法,构造虚拟控制力矩;随后通过一阶滑膜微分器估计虚拟控制力矩的导数,此步骤不仅有效地避免了“复杂爆炸性”困难的产生还减弱了对追踪信号的要求;然后运用自适应方法对模型的未知参数以及扰动相关量进行估计处理,最后回到反步协议方法设计带有双曲函数形式的控制力矩。该策略有效的实现了对参数未知的链式自动化弹仓输入死区有效控制的目标。
实施例一
本实施例公开了参数未知的链式自动化弹仓输入死区的控制方法,包括:
根据参数未知的链式自动化弹仓内部运行机理,建立其数学模型。
借助反步协议方法,设计虚拟控制力矩。
通过一阶滑膜微分器对虚拟控制力矩的导数进行估计处理。
借助自适应方法对模型中未知参数及扰动的相关量进行适当的估计。
回到反步协议步骤,通过上述工作的准备,并借助双曲函数设计最终的控制力矩。
参见附图1所示,具体实施例子中,参数未知的链式自动化弹仓,包括:主动轮、从动轮、储弹筒等结构,所述弹仓在力矩控制模式下的永磁无刷直流电机,电机通过减速器等一系列中间机构,带动主动轮转动,从而带动从动轮、储弹筒与弹筒中的弹丸一起转动。
链式自动化弹仓有两个系统参数:
系统等效到电机输出轴的转动惯量(M);
系统等效到电机输出轴的黏性阻尼系数(D);
这两个参数未知时,该系统就称为“参数未知的链式自动化弹仓”。
首先建立动态模型:参数未知的链式自动化弹仓的动力学方程可以表示为:
其中:M代表系统等效到电机输出轴的未知转动惯量;D代表系统等效到电机输出轴的未知黏性阻尼系数;q为电机转子位移;Td代表等效扰动,包括负载力矩、啮合冲动等难以建模的动态扰动;u代表控制输入力矩。
参见附图3所示,当弹仓的控制输入力矩发生未知死区时,输入可以表示为:
u(t)是弹仓系统实际收到的输入力矩;
v(t)是为弹仓系统设计的控制力矩;
m是弹仓的设计控制力矩v(t)发生死区时的死区系数;
br是弹仓系统实际收到的正向最小输入力矩大小;
bl是弹仓系统实际收到的负向最小输入力矩大小;
m、br、bl均为未知有界的正常数,更简单的可以表示为:
u(t)=mv(t)+d(t)
其中:
该弹仓模型可以进一步表示为以下无量纲化数学形式:
应用反步协议构造虚拟控制力矩:
首先引入坐标变换:
z1=x1-r(t),ZZ=xZ-α(t)
其中:α(t)为设计的虚拟控制力矩。然后选择李雅普诺夫预备函数:
构造虚拟控制力矩:
其中:r(t)为目标追踪信号,c1为大于1的设计参数。则对李雅普诺夫预备函数求导得:
参见附图4所示,借助一阶滑膜微分器对上步中设计的虚拟控制力矩的导数进行有效的估计,其中一阶滑膜微分器形为:
这里:sign为符号函数;μ0、μ1为两个调试参数,其设置与虚拟控制力矩有关;f0、f1为滑膜微分器系统的两个状态。根据一阶滑膜微分器的相关知识可以得知,只要调节参数μ0、μ1,以及一阶滑膜微分器中两个系统状态f0以及f1的初始值的大小,就可用η0有效的估计虚拟控制力矩α(t)的导数。
参见附图5所示,运用自适应估计对系统存在的未知参数进行适当的处理:
这里首先给出相关的符号定义:
未知参数的自适应更新率设计为:
再次回到反步协议方法,根据做相应的控制理论研究基础,这里构造李雅普诺夫函数:
对系统建模时,首先是将系统的所有相关信息(系统等效到电机输出轴的未知转动惯量、系统等效到电机输出轴的未知黏性阻尼系数)进行量化处理,因此在实际工程中,为链式弹仓设计控制力矩时,也要先将这些信息进行量化处理,然后再借用本方案里v(t)的设计来实现有界控制的目标。为链式自动化弹仓模型等价无量纲化模型死区系数倒数的估计;
Θ代表一些相关量作用的整体,在上述方案中已提出;
z2为变换系统的状态之一;
根据上述方案中系统未知参数自适应更新率的设置、虚拟控制力矩经过一阶滑膜微分器的估计设置,对李雅普诺夫函数V求导可得其导数满足:
其中:k、Δ均为参数。根据控制科学领域相关的理论知识可得,由此证明实现了参数未知的链式自动化弹仓输入死区的有界控制目标。
根据所设计控制器v的具体形式可知,实际的工程应用中,特别需要调节的工程参数主要为:γ1、γ2、γ3、σ1、σ2、σ3、μ0、μ1。但是这些参数只要满足大于零即可,具体的调试可以改善改善控制效果。
该方法的设计目标是实现系统有界追踪,即系统的输出x1有界跟踪期望目标r(t),
参数分别为:
M=4、D=0.8、m=2、br=0.8、bl=1(即:ρ=1.5、θ2=-0.2、c1=20、c2=20、ε=5、γ1=1、γ2=5、γ3=1、σ1=0.3、σ2=0.5、σ3=0.5、μ0=2、μ1=10。
实施例子二
本发明还公开了参数未知的链式自动化弹仓输入死区的控制系统,包括控制力矩及链式自动化弹仓,控制力矩控制链式自动化弹仓工作,所述控制力矩被配置通过下述方式实现:
建立参数未知的链式自动化弹仓的数学模型;
借助反步协议方法,设计虚拟控制力矩;
通过一阶滑膜微分器对虚拟控制力矩的导数进行估计处理;
利用自适应估计对模型中未知参数及扰动的相关量进行处理,借助双曲函数设计最终的控制力矩。
具体的控制力矩的设计步骤参见实施例子一中的详细描述。
实施例子三
本发明还公开了一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时实现实施例子一中的参数未知的链式自动化弹仓输入死区的控制方法的步骤。
实施例子四
本发明还公开了一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现实施例子一中的参数未知的链式自动化弹仓输入死区的控制方法的步骤。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
上述虽然结合附图对本发明的具体实施方式进行了描述,但并非对本发明保护范围的限制,所属领域技术人员应该明白,在本发明的技术方案的基础上,本领域技术人员不需要付出创造性劳动即可做出的各种修改或变形仍在本发明的保护范围以内。
Claims (7)
1.参数未知的链式自动化弹仓输入死区的控制方法,其特征是,包括:
建立参数未知的链式自动化弹仓的数学模型,链式自动化弹仓的数学模型为动态模型,动力学方程为:
其中:M代表系统等效到电机输出轴的未知转动惯量;D代表系统等效到电机输出轴的未知黏性阻尼系数;q为电机转子位移;Td代表等效扰动;u代表控制输入力矩;
借助反步协议方法,设计虚拟控制力矩;
通过一阶滑膜微分器对虚拟控制力矩的导数进行估计处理;
利用自适应估计对模型中未知参数及扰动的相关量进行处理,再次利用反步协议方法构造李雅普诺夫函数,借助双曲函数设计最终的控制力矩:
其中:为链式自动化弹仓模型等价无量纲化模型死区系数倒数的估计;Θ代表一些相关量作用的整体, 为θ2的估计,表示未知参数,c2为大于1的设计参数,z1=x1-r(t),z2=x2-α(t),α(t)为设计的虚拟控制力矩,r(t)为目标追踪信号,x1=q、为系统状态,f0为一阶滑膜微分器的系统状态,
z2为变换系统的状态之一;
其中,T是链式自动化弹仓模型等价无量纲化模型的扰动上界;
对李雅普诺夫函数V求导可得其导数满足:
其中:k、Δ均代替相关参数,这些参数只要满足大于零即可。
3.如权利要求1所述的参数未知的链式自动化弹仓输入死区的控制方法,其特征是,应用反步协议构造虚拟控制力矩,引入坐标变换,选择李雅普诺夫预备函数,构造虚拟控制力矩。
4.如权利要求1所述的参数未知的链式自动化弹仓输入死区的控制方法,其特征是,利用一阶滑膜微分器对虚拟控制力矩的导数进行估计处理,通过调节滑膜微分器中的参数,及其两个系统状态的初始值的大小,将有效估计出虚拟控制力矩的导数。
5.如权利要求1所述的参数未知的链式自动化弹仓输入死区的控制方法的系统,包括控制力矩及链式自动化弹仓,控制力矩控制链式自动化弹仓工作,所述控制力矩被配置通过下述方式实现:
建立参数未知的链式自动化弹仓的数学模型;
借助反步协议方法,设计虚拟控制力矩;
通过一阶滑膜微分器对虚拟控制力矩的导数进行估计处理;
利用自适应估计对模型中未知参数及扰动的相关量进行处理,借助双曲函数设计最终的控制力矩。
6.一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时实现权利要求1-4任一所述的参数未知的链式自动化弹仓输入死区的控制方法的步骤。
7.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现权利要求1-4任一所述的参数未知的链式自动化弹仓输入死区的控制方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911274588.9A CN110906782B (zh) | 2019-12-12 | 2019-12-12 | 参数未知的链式自动化弹仓输入死区的控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911274588.9A CN110906782B (zh) | 2019-12-12 | 2019-12-12 | 参数未知的链式自动化弹仓输入死区的控制方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110906782A CN110906782A (zh) | 2020-03-24 |
CN110906782B true CN110906782B (zh) | 2021-08-10 |
Family
ID=69824935
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911274588.9A Expired - Fee Related CN110906782B (zh) | 2019-12-12 | 2019-12-12 | 参数未知的链式自动化弹仓输入死区的控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110906782B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4210058A (en) * | 1978-09-25 | 1980-07-01 | General Electric Company | Balanced Gatling gun |
JPS61143700A (ja) * | 1984-11-19 | 1986-07-01 | ウエルクツオイクマシイネンフアブリ−ク・エ−リコン−ビユ−レ・アクチエンゲゼルシヤフト | 外力駆動火砲のための遅延点火の監視装置 |
CN1129800A (zh) * | 1993-12-20 | 1996-08-28 | 厄利肯-康特拉维斯股份公司 | 一种自动武器上的子弹夹 |
CN108828943A (zh) * | 2018-06-20 | 2018-11-16 | 南通航运职业技术学院 | 一种带扰动补偿和有限时间收敛的自抗扰控制方法 |
CN110095014A (zh) * | 2019-06-05 | 2019-08-06 | 重庆建设工业(集团)有限责任公司 | 一种链式供弹机枪输弹机构 |
-
2019
- 2019-12-12 CN CN201911274588.9A patent/CN110906782B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4210058A (en) * | 1978-09-25 | 1980-07-01 | General Electric Company | Balanced Gatling gun |
JPS61143700A (ja) * | 1984-11-19 | 1986-07-01 | ウエルクツオイクマシイネンフアブリ−ク・エ−リコン−ビユ−レ・アクチエンゲゼルシヤフト | 外力駆動火砲のための遅延点火の監視装置 |
CN1129800A (zh) * | 1993-12-20 | 1996-08-28 | 厄利肯-康特拉维斯股份公司 | 一种自动武器上的子弹夹 |
CN108828943A (zh) * | 2018-06-20 | 2018-11-16 | 南通航运职业技术学院 | 一种带扰动补偿和有限时间收敛的自抗扰控制方法 |
CN110095014A (zh) * | 2019-06-05 | 2019-08-06 | 重庆建设工业(集团)有限责任公司 | 一种链式供弹机枪输弹机构 |
Also Published As
Publication number | Publication date |
---|---|
CN110906782A (zh) | 2020-03-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104360596B (zh) | 机电伺服系统有限时间摩擦参数辨识和自适应滑模控制方法 | |
CN104002814B (zh) | 一种基于amt并联式混合动力车系统的换档方法、装置及车辆 | |
CN107612445B (zh) | 具有负载加速度反馈的随动调速系统控制方法 | |
CN110673472B (zh) | 基于神经网络补偿死区反演误差的自适应鲁棒控制方法 | |
CN109227545B (zh) | 一种基于可达集估计的柔性机械臂目标追踪控制方法 | |
CN113110059B (zh) | 基于事件触发的单连杆机械臂系统实际跟踪的控制方法 | |
CN108983801B (zh) | 一种基于反作用飞轮动态特性的航天器抗干扰姿控方法 | |
CN106452242B (zh) | 基于串并联估计模型的永磁同步电机混沌模糊控制方法 | |
CN112904726B (zh) | 一种基于误差重构权重更新的神经网络反步控制方法 | |
CN108155833B (zh) | 考虑电气特性的电机伺服系统渐近稳定控制方法 | |
CN108942935A (zh) | 基于输出位置的单臂机械手自适应控制器及控制方法 | |
CN107561929B (zh) | 一种伺服系统的无模型鲁棒自适应优化方法 | |
CN106406098B (zh) | 一种机器人系统在未知环境下的人机交互控制方法 | |
CN108453732A (zh) | 控制体系封闭机器人自适应动态力/位置混合控制方法 | |
Hung et al. | Adaptive control for nonlinearly parameterized uncertainties in robot manipulators | |
CN110011585B (zh) | 一种外部激励引起的永磁半直驱式传动轴系扭振控制方法 | |
CN110906782B (zh) | 参数未知的链式自动化弹仓输入死区的控制方法及系统 | |
TW201815035A (zh) | 狀態觀測器兼用型全閉合控制的諧波齒輪裝置之致動器的定位控制裝置 | |
CN110829933B (zh) | 基于发射平台的神经网络输出反馈自适应鲁棒控制方法 | |
CN108762066B (zh) | 一种直升机电动尾部减速器系统的控制方法 | |
CN104965413A (zh) | 受控化发射平台的摩擦补偿自适应控制方法 | |
CN114859725A (zh) | 一种非线性系统自适应事件触发控制方法及系统 | |
CN106802569A (zh) | 一种补偿执行机构死区非线性的自适应状态反馈控制方法 | |
Ghaeminezhad et al. | Stabilizing a gimbal platform using self-tuning fuzzy PID controller | |
JP2007270924A (ja) | 自動変速機のシミュレーション装置およびそのプログラム |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210810 Termination date: 20211212 |
|
CF01 | Termination of patent right due to non-payment of annual fee |