一种基于模态交互的柔性机械臂参激共振减振方法与流程

1.本发明涉及一种基于模态交互的柔性机械臂参激共振减振方法，其结合非线性理论，构造柔性机械臂和参激共振吸振器的动力学模型，使柔性机械臂的参激共振能量通过能量交换通道转移到参激共振吸振器中，并由吸振器的阻尼耗散，从而有效地控制柔性机械臂的参激共振响应。


背景技术：

2.随着自动化进程的推进，机械臂在工业制造、服务交互、武器装备、医疗手术以及航空航天等重要领域的应用越来越普及。传统刚性机械臂质量大，负载与自重比值小，在要求结构、动作迅速与高负载的场合下应用会受到限制。相比于传统刚性机械臂，柔性机械臂具有大跨高比和质量轻等特点，克服了刚性机械臂的不足，得到更广泛的应用。但是柔性机械臂由于结构柔性的存在，在工作过程中很容易产生难以快速消减的振动，这直接影响了柔性机械臂的控制精度和稳定性。若柔性机械臂发生共振，则会产生更加巨大的负面影响，可能导致其动力学性能急剧恶化，发生严重故障。因此，如何控制柔性机械臂的振动，已经是振动控制领域重点关注的问题。
3.参数振动是除自由振动、受迫振动和自激振动外的另一种振动形式，由持续的参数激励引起的共振称为参激共振。在柔性机械臂往复运动时，其部分结构或动力学参数会随之发生周期性变化，进而产生参数激励。柔性机械臂在运动中产生参数激励的频率随着机械臂工作任务的不同会在较宽的频谱上发生变化，因此，柔性机械臂低阶固有频率容易落进参数激励的频率范围，从而引发参激共振现象。对于大尺度、大柔度的柔性机械臂，参激共振会引起极为剧烈的振动响应，但其自身的阻尼并不能使振动快速衰减，从而造成巨大的损失。参激共振的存在限制了柔性机械臂的发展和应用，所以迫切需要新的方法来控制其振动。
4.目前为止，人类对于柔性机械臂的振动控制方面开展了广泛的研究，但针对参激共振控制的研究并不充分。鉴于此，本发明提出一种柔性机械臂参激共振的控制方法。通过使柔性机械臂和吸振器的频率满足一定公度关系，在两者之间产生模态耦合，基于模态交互原理构造柔性机械臂与吸振器的能量交换通道，使柔性机械臂的参激共振能量传递到吸振器中，再通过吸振器的阻尼将能量耗散，从而减小柔性机械臂末端幅值，有效控制参激共振。


技术实现要素：

5.本发明所要解决的技术问题在于针对现有技术的不足，为解决柔性机械臂在工作中参激共振控制问题，提出一种基于模态交互的柔性机械臂参激共振减振方法。该方法基于模态交互原理建立参激共振的能量传递通道，将参激共振能量传递给吸振器，进而通过吸振器阻尼耗散，实现参激共振的控制。本发明可应用于大尺度、大柔度的柔性机械臂系统的参激共振控制，具有良好的减振效果。
6.本发明为一种基于模态交互的柔性机械臂参激共振减振方法，该方法的基本原理和具体步骤如下：
7.本发明通过将参激共振吸振器安装在柔性机械臂上，使柔性机械臂和吸振器实现非线性耦合。基于模态交互原理，调节参激共振吸振器频率，从而构建柔性机械臂和参激共振吸振器之间的能量交换通道，将柔性机械臂的参激共振能量转移到吸振器中并由吸振器的阻尼耗散，以达到对柔性机械臂参激共振控制的目的。
8.步骤一：提炼可引起柔性机械臂共振的持续参数激励。
9.步骤二：对实际模型做合理假设，并将柔性臂杆关节持续变化的参数视为参数激励。
10.步骤三：计入柔性机械臂敏感方向的变形，将柔性机械臂做离散化处理。
11.步骤四：建立柔性机械臂以及参激共振吸振器的非线性动力学模型。
12.步骤五：根据柔性机械臂系统的非线性动力学模型构造参激共振吸振器控制方程。
13.步骤六：通过泰勒展开和无量纲处理等方法，对非线性动力学方程组做必要的简化。
14.步骤七：分析柔性机械臂动力学模型，求其稳态响应的近似解析解。
15.步骤八：对参激共振吸振器工作状态分类，求解柔性机械臂参激共振非耦合稳态响应与耦合稳态响应。
16.步骤九：分别对非耦合稳态响应和耦合稳态响应的稳定性进行分析。
17.步骤十：分析吸振器控制系数对参激共振的影响，选取最佳控制系数，从而达到对柔性机械臂参激共振良好的控制效果。
18.优选的，柔性机械臂往复运动时，其部分参数会发生周期性变化，从而产生参数激励。当柔性机械臂模态频率与参数激励频率接近时，则产生参激共振，故提取与柔性机械臂模态频率接近的持续参数激励。
19.优选的，假设柔性臂杆的结构与变形符合欧拉
‑
伯努利梁的特点，且柔性臂杆仅发生横向变形，不发生纵向变形，将柔性臂杆关节处持续变化的参数视为参数激励。
20.优选的，因为一般柔性机械臂的跨高比都较大，所以只需要考虑柔性机械臂的弯曲变形。将无限维模型简化为有限维模型，对柔性机械臂敏感方向做离散化处理。设柔性臂杆的横向变形为y(x,t)，其中，x表示柔性臂杆上某点到柔性臂杆关节沿柔性臂杆初始方向的距离，t表示时间，其横向变形方程可设为：φ
i
(x)是柔性臂杆的第i阶假设模态函数，q
i
(t)是与该阶模态函数对应的模态坐标；由于机械臂振动频率较低，故能量大部分集中在一阶模态中，所以横向变形公式中n＝1。
21.优选的，利用kane方法建立含参激共振吸振器的柔性机械臂非线性动力学模型，以柔性臂杆上某点模态坐标的变化速度与吸振器摆杆相对于吸振器电机的转速为广义坐标，通过求出系统的广义主动力k和广义惯性力k
*
，得出含吸振器的柔性机械臂非线性动力学模型：
[0022][0023]
将相应的广义主动力和广义惯性力代入方程(1)，并为柔性臂杆的一阶振动模态添加阻尼系数c，最终可得出动力学方程组。
[0024]
优选的，吸振器的振动频率由吸振器电机的扭矩m
c
决定。为了使柔性臂杆与吸振器之间形成能量交换通道，基于模态交互原理，对吸振器的频率进行调节；为了通过吸振器消耗振动能量，需要使吸振器具有一定阻尼。因此，设：则吸振器的频率为：其中k
p
与吸振器的刚度线性相关，k
d
与吸振器阻尼线性相关。
[0025]
通过方程(14)和方程(15)可知柔性臂杆一阶振动模态q1与吸振器模态之间存在非线性耦合，但其中非线性耦合均由柔性机械臂的结构决定，无法人为调节两个模态之间的耦合强度。为了能够对柔性臂杆和吸振器的模态耦合强度进行一定程度的调节，在m
c
的控制方程中添加人为构造的非线性项将吸振器转角与柔性臂杆上e点的一阶模态加速度进行耦合，得到：
[0026][0027]
非线性项n中，a为非线性系数。
[0028]
优选的，将步骤四中非线性方程组的三角函数在零点处做泰勒展开，略去高阶项，得到简化后的动力学模型：
[0029][0030][0031]
其中：
[0032][0033][0034]
为进一步简化方程组，对式(3)与式(4)进行归一化处理。定义：
[0035]
τ＝f
r
t，
[0036][0037]
可得：
[0038][0039][0040]
式中求导符号均表示对τ的求导。
[0041]
优选的，采用多尺度法求柔性机械臂动力学模型稳态响应的解析解，引入时间尺度，利用小量ε对系统变量进行重新刻度：
[0042][0043]
当柔性机械臂的模态频率与参数激励的频率接近时就会产生参激共振，这种情况下即使是小幅的参数激励也会引起明显的振动响应，故对参数激励振幅进行重新刻度：a＝ε2a。
[0044]
最终可求得稳态响应的近似解析解：
[0045][0046][0047]
优选的，在参激共振的状态下，当柔性机械臂固有频率与参激共振吸振器频率满足一定的公度关系时，柔性机械臂与吸振器之间可基于模态交互原理构造能量交换通道，从而使柔性机械臂和吸振器达到稳定的状态。通过引入解谐引子σ1与σ2，即可得求此时柔性臂杆的被控模态与吸振器模态在参激共振情况下的稳态方程组，分别讨论吸振器是否工作，即可得到如式(10)所示的非耦合解，以及如式(11)所示的耦合解。
[0048][0049][0050]
优选的，求得柔性机械臂与参激共振吸振器耦合状态和非耦合状态的雅可比矩
阵，代入非耦合解条件，利用特征值判定其稳定性；代入耦合解条件，根据劳斯
‑
赫尔维茨定理得到耦合解稳定的充要条件，给定系统参数后，即可判定其稳定性。
[0051]
优选的，运用控制变量法，通过数值仿真逐一判断阻尼项和非线性系数对参激共振控制的影响，从而选取最佳控制系数，以达到参激共振柔性机械臂良好的控制效果。
[0052]
本发明与现有技术相比的优点在于：
[0053]
柔性机械臂动力学系统是典型的非线性系统，其在工作中极易产生参激共振现象。本发明针对目前柔性机械臂参激共振控制研究尚不充分的现状，提出一种新的参激共振控制方法。本方法依据非线性动力学理论中的模态交互与能量迁移原理，通过构建柔性机械臂模态频率与参激共振吸振器模态频率的公度关系，使吸振器吸收并耗散柔性机械臂的参激共振能量，从而抑制柔性机械臂的参激共振。除此之外，为更有效地抑制机械臂振动，本发明对参激共振的重要控制参数进行了优化。利用数值仿真方法，得到控制参数与柔性机械臂振幅的关系，从而选取最优控制参数，以达到良好的参激共振控制效果。
附图说明
[0054]
图1为本发明中含参激共振吸振器的柔性机械臂整体结构示意图；
[0055]
图2为本发明中参激共振控制方法流程图；
[0056]
图3为本发明中柔性机械臂与吸振器的模态交互图；
[0057]
图4为本发明中吸振器的作用下柔性机械臂与吸振器振幅图；
[0058]
图5为本发明中吸振器阻尼项对柔性机械臂被控模态振幅的影响；
[0059]
图6为本发明中非线性系数对柔性机械臂被控模态振幅的影响；
[0060]
图7为本发明中基于反馈控制的simulink方框图；
[0061]
图8为本发明中吸振器不工作和吸振器有效控制参数下柔性臂杆末端加速度响应对比图。
[0062]
图1中符号说明如下：
[0063]
图中o、a、b、c分别为坐标系x
o
oy
o
、x
a
ay
a
、x
b
by
b
、x
c
cy
c
的原点，d为吸振器摆杆末端，e为柔性机械臂上一点；表示刚性臂杆相对于惯性坐标系的转角；表示柔性臂杆相对于a系的刚性转角；y
e
表示位于柔性臂杆上某点e横向变形量；表示吸振器摆杆相对于b系的转角。
具体实施方式：
[0064]
以下结合附图及具体实例对本发明作进一步详细说明，但本发明的实施不限于此。
[0065]
本发明提出一种基于模态交互的柔性机械臂参激共振减振方法，其结合非线性理论，通过构造柔性机械臂与吸振器能量传递通道，以达到减小柔性机械臂参激共振末端振幅的目的。图1为简化模型示意图，用以代替参激共振吸振器与柔性机械臂。
[0066]
该方法具体步骤如下：
[0067]
步骤一：提炼可引起柔性机械臂共振的持续参数激励。
[0068]
针对柔性机械臂的往复工作运动，提取发生周期变化并与柔性机械臂被控模态频率接近的参数，将其视为引发柔性机械臂参激共振的参数激励。
[0069]
步骤二：对实际模型做合理假设，并把柔性臂杆关节处持续变化的参数视为参数激励。
[0070]
柔性机械臂结构多种多样，本实例以最常见的二自由度刚柔耦合机械臂为例进行方法演示，但本发明的实施不限于此。对二自由度刚柔耦合机械臂做合理假设，假设柔性臂杆的结构与变形符合欧拉
‑
伯努利梁的特点，并且仅发生横向变形，不发生纵向变形。建立坐标系，如图1所示，其中，o、a、b、c分别为坐标系x
o
oy
o
、x
a
ay
a
、x
b
by
b
、x
c
cy
c
的原点，d为吸振器摆杆末端，e为柔性机械臂上一点；表示刚性臂杆相对于惯性坐标系的转角；表示柔性臂杆相对于a系的刚性转角；y
e
表示位于柔性臂杆上某点e横向变形量；表示吸振器摆杆相对于b系的转角。设关节b的工作运动规律为：因其工作频率与柔性机械臂被控的第一阶模态频率接近，故将其视为引发柔性机械臂参激共振的参数激励。
[0071]
步骤三：计入柔性机械臂敏感方向的变形，并对柔性机械臂做离散化处理。
[0072]
设柔性臂杆的横向变形为y(x,t)，其中x表示柔性臂杆上某点到柔性臂杆关节沿柔性臂杆初始方向的距离，t表示时间，其横向变形可设为：φ
i
(x)是柔性臂杆的第i阶假设模态函数，q
i
(t)是与该阶模态函数对应的模态坐标。
[0073]
柔性臂杆的振动一般频率较低且其跨高比大，通常以横向变形为主。因此，振动能量大多集中在低阶模态中，并且大部分位于一阶模态中。故将式简化为：
[0074]
y(x,t)＝φ1(x)q1(t)
ꢀꢀ
(12)
[0075]
步骤四：建立柔性机械臂以及参激共振吸振器的非线性动力学模型。
[0076]
本实例中利用kane方法建立柔性机械臂动力学方程组，但可应用的建模方法不限于此。如图1所示的模型中，刚性臂杆相对于惯性坐标系的转速柔性臂杆根部相对于刚性臂杆的转速柔性臂杆上某点的模态坐标的变化速度与吸振器摆杆相对于吸振器电机的转速是相互独立的，故设广义速度为：
[0077][0078]
根据所设的广义速度，求得b、c、d、e的偏速度。根据kane方法，通过偏速度，求得系统的广义主动力和广义惯性力。由于四个独立运动变量中，和是机械臂工作时人为给定的运动控制变量，其运动是已知的，因此可得到关于q1和的运动方程为：
[0079][0080]
将式(1)中的广义主动力和广义惯性力展开，并为柔性臂杆的一阶振动模态添加阻尼系数c，得到动力学方程组：
[0081][0082][0083]
根据式(14)可得出柔性臂杆的一阶固有频率：
[0084][0085]
当f
b
接近或等于f
r
时，柔性机械臂系统将发生参激共振。
[0086]
步骤五：根据柔性机械臂系统的非线性动力学模型构造参激共振吸振器控制模型。
[0087]
根据步骤四中式(15)可得，吸振器的振动频率由吸振器电机的扭矩m
c
决定。为了使柔性臂杆与吸振器之间形成能量传递通道，基于模态交互理论，对吸振器的频率进行调节；此为，为了使吸振器消耗振动能量，需要使吸振器具有一定阻尼。因此，设：
[0088][0089]
则吸振器的频率为：
[0090][0091]
其中k
p
与吸振器刚度项线性相关，k
d
与吸振器阻尼项线性相关。
[0092]
式(14)与(15)中包含柔性臂杆一阶振动模态q1与吸振器模态的非线性耦合项，因此，柔性臂杆一阶振动模态q1与吸振器模态之间存在交互现象，这是在两个模态之间形成能量传递通道的基础。但是，这些非线性耦合均由柔性机械臂的结构决定，无法人为调节两个模态之间的耦合强度。为了能够对耦合强度进行一定程度的调节，在m
c
的控制方程中添加人为构造的非线性项将吸振器转角与柔性臂杆上e点的一阶模态加速度进行耦合，得到：
[0093][0094]
非线性项n中，a为非线性系数。
[0095]
步骤六：通过泰勒展开和无量纲处理等方法，对非线性动力学方程组做必要的简化。
[0096]
将式(14)和式(15)中的三角函数在零点做泰勒展开，略去展开式中的高次项，并代入式(2)中得到简化后的动力学方程组为：
[0097][0098][0099]
其中：
[0100][0101][0102]
为进一步简化方程组，对式(3)与式(4)进行归一化处理。定义：
[0103]
τ＝f
r
t，
[0104][0105]
对式(3)和(4)进行归一化处理可得：
[0106][0107][0108]
式中的求导符号均表示对τ的求导。
[0109]
步骤七：分析柔性机械臂动力学模型，求其稳态响应的近似解析解。
[0110]
本发明利用多尺度法求解归一化后动力学方程组的近似稳态解，但求解方法不局限于多尺度法。
[0111]
根据多尺度法求解方法，引入时间尺度，利用小量ε对系统变量进行重新刻度：
[0112][0113]
柔性机械臂进行往复运动时，部分参数会随之产生周期性变化，从而产生参数激励。当柔性机械臂的模态频率与参数激励的频率接近时就会产生参激共振，这种情况下即使是小幅的参数激励也会引起明显的振动响应。因此，本发明中假设参数激励幅度比机械臂刚性运动的量级小，对参数激励振幅进行重新刻度：
[0114]
a＝ε2a
ꢀꢀ
(19)
[0115]
根据求导法则：
[0116][0117][0118]
根据多尺度法，选取求解精度，引入二阶摄动解：
[0119][0120][0121]
将式(7)、式(8)、式(22)和式(23)代入式(5)与式(6)中，并按照小参量ε的阶次整理得到如下系数方程：
[0122]
ε0阶项的系数：
[0123][0124][0125]
ε1阶项的系数：
[0126][0127][0128]
设式(24)与式(25)的解为：
[0129][0130][0131]
把式(28)和式(29)代入式(26)、式(27)可得：
[0132][0133][0134]
其中，cc为该式右侧中之前所有项的共轭之和，r
nst
为该式中的非长期项。
[0135]
令式(30)与式(31)中的长期项的和为0，即可求出稳态响应的近似解析解：
[0136][0137][0138]
步骤八：对参激共振吸振器工作状态进行分类，求解柔性机械臂参激共振的非耦合稳态响应和耦合稳态响应。
[0139]
柔性机械臂、参激共振吸振器之间的能量传递能力与二者的公度关系有关，基于模态交互原理，当柔性机械臂被控模态频率和吸振器频率的比值为2：1时，即可构建两模态之前的能量交换通道，其模态交互如图3所示。在这种情况下，求取柔性臂杆一阶振动模态与吸振器模态在参激共振发生时的稳态解。
[0140]
引入解谐因子σ1与σ2，设：
[0141][0142]
为了求得稳态解，将式(32)代入式(8)和式(9)中，令长期项的和为0，得到：
[0143][0144][0145]
其中，a1、θ1、a2、θ2都是关于t1的实函数。
[0146]
把代入式(33)和(34)，分离式(33)和(34)的实部和虚部，并令其均为0，可以求出：
[0147][0148]
[0149][0150][0151]
式中β1＝2σ1t1 2θ2‑
θ1，将β1与β2对t1求导，并代入式(37)与式(38)整理得：
[0152][0153][0154]
微分方程组(35)、(36)、(39)与(40)稳态解的存在条件为a1′
＝0，a2′
＝0，β1′
＝0，β2′
＝0，将其代入式(35)、式(36)、式(39)和式(40)整理得到参激共振稳态方程组：
[0155][0156][0157][0158][0159]
当a2＝0时，求得非耦合稳态响应：
[0160][0161]
a2＝0的物理含义是吸振器模态振幅为零，即吸振器未工作。由式(10)可知柔性臂杆一阶模态振幅与能引起共振的参数激励幅值a的大小成正比。
[0162]
当a2≠0时，求得耦合稳态响应：
[0163][0164]
a2≠0时，根据上述数学计算可知，柔性臂杆一阶模态的稳态振幅为一个定值，并
不随着能引起共振的参数激励幅值a的大小变化而变化。此时，参激共振的柔性机械臂系统出现了饱和现象。
[0165]
分析式(11)可知，a2并不总是存在实数解，其存在实数解的条件为：
[0166][0167]
步骤九：分别对非耦合稳态响应和耦合稳态响应的稳定性进行分析。
[0168]
引入笛卡尔坐标变换，并将其求导：
[0169][0170]
将式(35)式(36)式(39)式(40)代入式(46)中即可求得雅可比矩阵：
[0171][0172]
将非耦合解的条件a2＝0代入雅可比矩阵，使特征值实部均小于零，求得振幅阈值a
1c
：
[0173][0174]
将耦合解的条件为a2≠0代入雅可比矩阵，计算矩阵的特征多项式，整理可得：
[0175]
[0176]
最后根据劳斯
‑
赫尔维茨定理得到耦合解稳定的充要条件：将任意一组参数代入该不等式组，即可判断耦合解是否稳定。
[0177]
图4为本发明中吸振器作用下的柔性机械臂与吸振器振幅图，红色表示柔性臂杆被控模态振幅，蓝色表示吸振器模态振幅；虚线表示不稳定的解，实线表示稳定的解，图像结果与步骤九中稳定性理论分析一致。
[0178]
步骤十：分析参激共振吸振器控制系数对参激共振的影响，选取最佳控制系数，从而达到参激共振柔性机械臂被控模态的良好控制效果。
[0179]
当柔性机械臂和参激共振吸振器的物理参数确定，并且两者之间产生模态交互现象后，柔性机械臂在不同幅值的参数激励下，其幅值将不会发生变化。通过计算分析可得，此时柔性机械臂末端幅值受到吸振器控制参数的影响，故主要分析吸振器可调控制参数(ζ2、a)对参激共振柔性机械臂末端幅值的影响。
[0180]
本步骤采取控制变量法进行分析，首先确定柔性臂杆系统物理参数以及参数激励频率，再分别使非线性系数a(阻尼项ζ2)保持不变，分析阻尼项ζ2(非线性系数a)的变化对参激共振控制的影响。
[0181]
为进一步直观表述本发明选取控制参数的方法，给定以下算例。假设系统已产生能量传递通道，并且发生参激共振，分别对两控制系数(ζ2、a)进行讨论，图7为基于反馈控制的simulink方框图。
[0182]
①
令非线性系数a为0，设置刚性臂杆转角参数激励幅值a＝0.01rad、设置参数激励频率f
b
为4.27rad/s。令吸振器阻尼ζ2分别为0.02、0.07、0.10与0.13。其数值仿真计算出的柔性臂杆末端响应曲线与吸振器摆角响应曲线如图5所示，ζ2取0.02时，吸振器消耗振动能量的效率较低，不能持续稳定的耗散柔性臂杆的振动能量；ζ2分别取值0.07、0.10与0.13时，对应的柔性臂杆末端振幅最大值分别为33.9mm、47.6mm与60.0mm。通过数值仿真可以观察到，随着吸振器阻尼取值的增大，柔性臂杆模态的参激共振饱和幅值随之增大，同时柔性臂杆模态进入稳定状态的时间也随之提前。因此，吸振器阻尼的取值要在保证柔性臂杆模态能够快速进入饱和状态的前提下尽量取较小的值。
[0183]
②
令阻尼项ζ2为0.07，设置刚性臂杆转角参数激励幅值a＝0.01rad、设置参数激励频率f
b
为4.27rad/s。令非线性系数a分别取值为0、8
×
10
‑4与2
×
10
‑3。其数值仿真计算出的柔性臂杆末端响应曲线与吸振器摆角响应曲线如图6所示，非线性系数a分别取值0、8
×
10
‑4、2
×
10
‑3时，对应的柔性臂杆末端振幅最大值分别为33.9mm、32.8mm、31.9mm。通过数值仿真可以观察到，当非线性系数在[0,2
×
10
‑3]之间，随着其取值的增大，系统进入饱和状态的时间提前，并且柔性臂杆模态幅值随之减小。
[0184]
针对柔性机械臂受到参数激励并且其与参激共振吸振器间产生能量传递通道的情况进行分析，设置吸振器阻尼控制ζ2为0.07、非线性系数a为2
×
10
‑3、刚性臂杆转角参数激励幅值a＝0.01rad、参数激励频率f
b
为4.27rad/s。联合仿真得出柔性臂杆末端响应曲线对比图如图8所示，图中灰色线是吸振器不工作的状态下柔性臂杆末端响应，黑色线为吸振器在给定参数下柔性臂杆末端响应。在参激共振的情
况下，吸振器不工作时，柔性臂杆末端会产生较大振动响应，最大振幅为255mm；吸振器参数配置完成后，最初柔性臂杆末端的最大振幅为129mm，稳定后的振幅为63.5mm。因此，本发明有效抑制了柔性机械臂的参激共振。

技术特征：
1.一种基于模态交互的柔性机械臂参激共振减振方法，其方法具体步骤如下：步骤一：提炼可引起柔性机械臂共振的持续参数激励。步骤二：对实际模型做合理假设，并将柔性臂杆关节持续变化的参数视为参数激励。步骤三：计入柔性机械臂敏感方向的变形，将柔性机械臂做离散化处理。步骤四：建立柔性机械臂以及参激共振吸振器的非线性动力学模型。步骤五：根据柔性机械臂系统的非线性动力学模型构造参激共振吸振器控制方程。步骤六：通过泰勒展开和无量纲处理等方法，对非线性动力学方程组做必要的简化。步骤七：分析柔性机械臂动力学模型，求其稳态响应的近似解析解。步骤八：对参激共振吸振器工作状态分类，求解柔性机械臂参激共振非耦合稳态响应与耦合稳态响应。步骤九：分别对非耦合稳态响应和耦合稳态响应的稳定性进行分析。步骤十：分析吸振器控制系数对参激共振的影响，选取最佳控制系数，从而达到对柔性机械臂参激共振良好的控制效果。2.如权利要求1所述的一种基于模态交互的柔性机械臂参激共振减振方法其特征在于步骤一中，柔性机械臂往复运动时，其部分参数会发生周期性变化，从而产生参数激励。当柔性机械臂模态频率与参数激励频率接近时，则产生参激共振，故提取与柔性机械臂模态频率接近的持续参数激励。3.如权利要求1所述的一种基于模态交互的柔性机械臂参激共振减振方法其特征在于步骤二中，假设柔性臂杆的结构与变形符合欧拉
‑
伯努利梁的特点，且柔性臂杆仅发生横向变形，不发生纵向变形，将柔性臂杆关节处持续变化的参数视为参数激励。4.如权利要求1所述的一种基于模态交互的柔性机械臂参激共振减振方法其特征在于步骤三中，因为一般柔性机械臂的跨高比都较大，所以只需要考虑柔性机械臂的弯曲变形。将无限维模型简化为有限维模型，对柔性机械臂敏感方向做离散化处理。设柔性臂杆的横向变形为y(x,t)，其中，x表示柔性臂杆上某点到柔性臂杆关节沿柔性臂杆初始方向的距离，t表示时间，其横向变形方程可设为：φ
i
(x)是柔性臂杆第i阶的假设模态函数，q
i
(t)是与该阶模态函数对应的模态坐标；由于柔性机械臂振动频率较低，故能量大部分集中在一阶模态中，所以横向变形公式中n＝1。5.如权利要求1所述的一种基于模态交互的柔性机械臂参激共振减振方法其特征在于步骤四中，利用kane方法建立含参激共振吸振器的柔性机械臂非线性动力学模型，以柔性臂杆上某点模态坐标的变化速度与吸振器摆杆相对于吸振器电机的转速为广义坐标，通过求出系统的广义主动力k和广义惯性力k
*
，得出含吸振器的柔性机械臂非线性动力学模型：将相应的广义主动力和广义惯性力代入方程(1)，并为柔性臂杆的一阶振动模态添加阻尼系数c，最终可得出动力学方程组。6.如权利要求1所述的一种基于模态交互的柔性机械臂参激共振减振方法其特征在于
步骤五中，吸振器的振动频率由吸振器电机的扭矩m
c
决定。为了使柔性臂杆与吸振器之间形成能量交换通道，基于模态交互原理，对吸振器的频率进行调节；为了通过吸振器消耗振动能量，需要使吸振器具有一定阻尼。因此，设：则吸振器的频率为：其中k
p
与吸振器的刚度线性相关，k
d
与吸振器阻尼线性相关。柔性臂杆一阶振动模态q1与吸振器模态之间存在非线性耦合，但其中非线性耦合均由柔性机械臂的结构决定，无法人为调节两个模态之间的耦合强度。为了能够对柔性臂杆和吸振器的模态耦合强度进行一定程度的调节，在m
c
的控制方程中添加人为构造的非线性项将吸振器转角与柔性臂杆上e点的一阶模态加速度进行耦合，得到：非线性项n中，a为非线性系数。7.如权利要求1所述的一种基于模态交互的柔性机械臂参激共振减振方法其特征在于步骤六中，将步骤四中非线性方程组的三角函数在零点处做泰勒展开，略去高阶项，得到简化后的动力学模型：化后的动力学模型：其中：其中：其中：为进一步简化方程组，对式(3)与式(4)进行归一化处理。定义：τ＝f
r
t，t，可得：
式中求导符号均表示对τ的求导。8.如权利要求1所述的一种基于模态交互的柔性机械臂参激共振减振方法其特征在于步骤七中，采用多尺度法求柔性机械臂动力学模型稳态响应的解析解，引入时间尺度，利用小量ε对系统变量进行重新刻度：当柔性机械臂的模态频率与参数激励的频率接近时就会产生参激共振，这种情况下即使是小幅的参数激励也会引起明显的振动响应，故对参数激励振幅进行重新刻度：a＝ε2a。最终可求得稳态响应的近似解析解：稳态响应的近似解析解：9.如权利要求1所述的一种基于模态交互的柔性机械臂参激共振减振方法其特征在于步骤八中，在参激共振的状态下，当柔性机械臂固有频率与参激共振吸振器频率满足一定的公度关系时，柔性机械臂与吸振器之间可基于模态交互原理构造能量交换通道，从而使柔性机械臂和吸振器达到稳定的状态。通过引入解谐引子σ1与σ2，即可得求此时柔性臂杆的被控模态与吸振器模态在参激共振情况下的稳态方程组，分别讨论吸振器是否工作，即可得到如式(10)所示的非耦合解，以及如式(11)所示的耦合解。得到如式(10)所示的非耦合解，以及如式(11)所示的耦合解。10.如权利要求1所述的一种基于模态交互的柔性机械臂参激共振减振方法其特征在于步骤九中，求得柔性机械臂与参激共振吸振器耦合状态和非耦合状态的雅可比矩阵，代入非耦合解条件，利用特征值判定其稳定性；代入耦合解条件，根据劳斯
‑
赫尔维茨定理得到耦合解稳定的充要条件，给定系统参数后，即可判定其稳定性。11.如权利要求1所述的一种基于模态交互的柔性机械臂参激共振减振方法其特征在
于步骤十中，运用控制变量法，通过数值仿真逐一判断阻尼项和非线性系数对参激共振控制的影响，从而选取最佳控制系数，以达到参激共振柔性机械臂良好的控制效果。
技术总结
本发明公开了一种基于模态交互的柔性机械臂参激共振减振方法，该方法主要包括：提炼可引起柔性机械臂共振的持续参数激励；对实际模型做合理假设，将柔性臂杆关节持续变化的参数视为参数激励；计入柔性机械臂敏感方向的变形，对柔性机械臂做离散化处理；建立含参激共振吸振器的柔性机械臂非线性动力学模型；基于模态交互原理构造参激共振吸振器控制方程；对动力学模型做归一化处理，求稳态响应的近似解析解；对参激共振吸振器工作状态分类讨论，求解非耦合稳态响应与耦合稳态响应，并对其稳定性进行分析；最后分析吸振器控制系数对参激共振的影响，选取最佳控制系数，从而达到抑制柔性机械臂参激共振的目的。性机械臂参激共振的目的。性机械臂参激共振的目的。


技术研发人员：边宇枢 耿瑞海 田冬博 彭佳乐 靳博涵
受保护的技术使用者：北京航空航天大学
技术研发日：2021.03.29
技术公布日：2021/6/24