一种时变非线性质量弹簧阻尼系统的运动控制方法 |
|||||||
申请号 | CN201911144331.1 | 申请日 | 2019-11-20 | 公开(公告)号 | CN110806688A | 公开(公告)日 | 2020-02-18 |
申请人 | 中山大学; | 发明人 | 施妮妮; 张雨浓; 黄焕昌; 郭津津; 毛明志; | ||||
摘要 | 本 发明 公开一种时变非线性 质量 弹簧 阻尼系统的运动控制方法,包括以下步骤:通过时变非线性质量弹簧阻尼系统,得到时变非线性质量弹簧阻尼系统的数学模型;通过时变非线性质量弹簧阻尼系统的数学模型,得到时变非线性质量弹簧阻尼系统的动 力 学方程组;通过时变非线性质量弹簧阻尼系统的动力学方程组,利用零化动力学方法,得到时变非线性质量弹簧阻尼系统的运动 控制器 ;通过时变非线性质量弹簧阻尼系统的运动控制器,利用时间离散公式得到对应的未来的控制输入参数。本发明基于零化动力学方法和时间离散公式,实现了对时变非线性质量弹簧阻尼系统的高 精度 实时运动控制。 | ||||||
权利要求 | 1.一种时变非线性质量弹簧阻尼系统的运动控制方法,其特征在于,包括以下步骤: |
||||||
说明书全文 | 一种时变非线性质量弹簧阻尼系统的运动控制方法技术领域[0001] 本发明涉及质量弹簧阻尼系统控制领域,更具体地,涉及一种时变非线性质量弹簧阻尼系统的运动控制方法。 背景技术[0002] 质量弹簧阻尼系统作为一种常见的机械振动系统,在柔性机器人、汽车缓冲器和减震装置等应用中被广泛采用。在实际工作过程中,质量弹簧阻尼系统通常会受到许多外界因素的干扰,使得控制性能无法达到预期目标,甚至直接影响到整个工程的实际效果。对此,许多研究提出针对质量弹簧阻尼系统的控制策略,以便减轻扰动对系统的影响并保证系统能够较精确地控制目标位置。 [0003] 以往的研究多涉及对传统的质量弹簧阻尼系统的运动控制。然而,目前大多数传统的质量弹簧阻尼系统属于线性定常系统,而在许多实际的应用场景中,质量弹簧阻尼系统更可能是一个具有时变相关系数的非线性系统。在此情况下,许多传统的控制策略难以甚至无法有效处理该系统的运动控制问题。 发明内容[0004] 为克服上述现有技术与方法的不足,本发明提出了一种时变非线性质量弹簧阻尼系统的运动控制方法。本发明基于零化动力学方法和时间离散公式,实现了对时变非线性质量弹簧阻尼系统的高精度实时运动控制。 [0005] 为解决上述技术问题,本发明的技术方案如下: [0006] 一种时变非线性质量弹簧阻尼系统的运动控制方法,包括以下步骤: [0007] 通过时变非线性质量弹簧阻尼系统,得到时变非线性质量弹簧阻尼系统的数学模型; [0008] 通过时变非线性质量弹簧阻尼系统的数学模型,得到时变非线性质量弹簧阻尼系统的动力学方程组; [0009] 通过时变非线性质量弹簧阻尼系统的动力学方程组,利用零化动力学方法,得到时变非线性质量弹簧阻尼系统的运动控制器; [0010] 通过时变非线性质量弹簧阻尼系统的运动控制器,利用时间离散公式得到对应的未来时刻的控制输入参数和未来时刻的输出参数。 [0011] 本发明中,零化动力学方法(Zhang neural dynamics或者zeroing dynamics),来源于会议论文“Comparison on Gradient-Based Neural Dynamics and Zhang Neural Dynamics for Online Solution of Nonlinear Equations”;对应的Online ISBN:978-3-540-92137-0;公开时间:ISICA 2008,19-21December。 [0012] 在一种优选的方案中,所述的时变非线性质量弹簧阻尼系统的动力学方程组通过下式进行表达: [0013] [0014] 其中,所述的x是位移;所述的y是速度;所述的m为时变非线性质量弹簧阻尼系统的时变质量;所述的k为时变非线性质量弹簧阻尼系统的时变弹簧因子;所述的b为时变非线性质量弹簧阻尼系统的时变阻尼因子;所述的fMSD为时变非线性质量弹簧阻尼系统所受的外力;所述的z是实际输出;所述的υ()是加速度。 [0015] 在一种优选的方案中,所述的fMSD通过下式进行表达: [0016] [0017] 其中,所述的zd表示期望输出。 [0018] 在一种优选的方案中,所述的控制输入参数通过下式进行表达: [0019] [0020] 其中,所述的g是采样间隔;所述的c1,c2,c3,…,cn+1是预设常数;所述的fMSD(ti+1)是下一时刻的fMSD;所述的fMSD(ti)是当前时刻的fMSD;所述的fMSD(ti-1)是上一时刻的fMSD;所述的fMSD(ti-n+1)是前n-1时刻的fMSD。 [0021] 在一种优选的方案中,所述的输出参数包括x(ti+1),所述的x(ti+1)通过下式进行表达: [0022] [0023] 其中,所述的a1,a2,a3,an+1是预设常数;所述的x(ti+1)是下一时刻的x;所述的x(ti)是当前时刻的x;所述的x(ti-1)是上一时刻的x;所述的x(ti-n+1)是前n-1时刻的x。 [0024] 在一种优选的方案中,所述的输出参数还包括y(ti+1),所述的y(ti+1)通过下式进行表达: [0025] [0026] 其中,所述的d1,d2,d3,dn+1是预设常数;所述的y(ti+1)是下一时刻的y;所述的y(ti)是当前时刻的y;所述的y(ti-1)是上一时刻的y;所述的y(ti-n+1)是前n-1时刻的y。 [0027] 与现有技术相比,本发明技术方案的有益效果是: [0030] 图2为时变非线性质量弹簧阻尼系统简化模型的示意图; [0031] 图3为实施例处理时变非线性质量弹簧阻尼系统的x(ti+1)示意图; [0032] 图4为实施例处理时变非线性质量弹簧阻尼系统的y(ti+1)示意图; [0033] 图5为实施例处理时变非线性质量弹簧阻尼系统的m(ti+1)示意图; [0034] 图6为实施例处理时变非线性质量弹簧阻尼系统的k(ti+1)示意图; [0035] 图7为实施例处理时变非线性质量弹簧阻尼系统的b(ti+1)示意图; [0036] 图8为实施例处理时变非线性质量弹簧阻尼系统的fMSD(ti+1)示意图; [0037] 图9为实施例处理时变非线性质量弹簧阻尼系统的z(ti+1)和zd(ti+1)示意图; [0038] 图10为实施例处理时变非线性质量弹簧阻尼系统的|e(ti+1)|示意图。 具体实施方式[0040] 对于本领域技术人员来说,附图中某些公知结构及其说明可能省略是可以理解的。下面结合附图和实施例对本发明的技术方案做进一步的说明。 [0041] 实施例 [0042] 如图1所示,一种时变非线性质量弹簧阻尼系统的运动控制方法,包括以下步骤: [0043] 通过时变非线性质量弹簧阻尼系统,得到时变非线性质量弹簧阻尼系统的数学模型; [0044] 通过时变非线性质量弹簧阻尼系统的数学模型,得到时变非线性质量弹簧阻尼系统的动力学方程组; [0045] 通过时变非线性质量弹簧阻尼系统的动力学方程组,利用零化动力学方法,得到时变非线性质量弹簧阻尼系统的运动控制器; [0046] 通过时变非线性质量弹簧阻尼系统的运动控制器,利用时间离散公式得到对应的未来时刻的控制输入参数和未来时刻的输出参数。 [0047] 在上述实施例中,时变非线性质量弹簧阻尼系统的动力学方程组通过下式进行表达: [0048] [0049] 其中,x是位移;y是速度;m为时变非线性质量弹簧阻尼系统的时变质量;k为时变非线性质量弹簧阻尼系统的时变弹簧因子;b为时变非线性质量弹簧阻尼系统的时变阻尼因子;fMSD为时变非线性质量弹簧阻尼系统所受的外力;z是实际输出;υ()是加速度。 [0050] 在上述实施例中,fMSD通过下式进行表达: [0051] [0052] 其中,zd表示期望输出。 [0053] 在上述实施例中,控制输入参数通过下式进行表达: [0054] [0055] 其中,g是采样间隔;c1,c2,c3,…,cn+1是预设常数;fMSD(ti+1)是下一时刻的fMSD;fMSD(ti)是当前时刻的fMSD;fMSD(ti-1)是上一时刻的fMSD;fMSD(ti-n+1)是前n-1时刻的fMSD。 [0056] 在上述实施例中,输出参数包括x(ti+1),所述的x(ti+1)通过下式进行表达: [0057] [0058] 其中,a1,a2,a3,an+1是预设常数;x(ti+1)是下一时刻的x;x(ti)是当前时刻的x;x(ti-1)是上一时刻的x;x(ti-n+1)是前n-1时刻的x。 [0059] 在上述实施例中,所述的y(ti+1)通过下式进行表达: [0060] [0061] 其中,d1,d2,d3,dn+1是预设常数;y(ti+1)是下一时刻的y;y(ti)是当前时刻的y;y(ti-1)是上一时刻的y;y(ti-n+1)是前n-1时刻的y。 [0062] 对应的测试案例 [0063] 图2为时变非线性质量弹簧阻尼系统的简化模型。建立对应的动力学方程: [0064] [0065] 结合零化动力学方法,得出时变非线性质量弹簧阻尼系统的运动控制器为同时,为了满足数字计算机的数字量处理要求,采用新型时间离散公式,获得如下用于数字计算机控制的控制输入量: [0066] [0067] 令c1=280/781,c2=257/983,c3=-280/781,c4=-364/781,c5=35/781,c6=805/3124,c7=-126/3905,c8=-245/2343,c9=3/77,其余为0。因此,控制输入量修改为: [0068] [0069] 采样间隔设定为g=0.01s,执行时间设定为50s,系统的时变质量设定为m=0.2sin(0.05t)+0.8,系统的时变弹簧因子设定为k=2cos(sin(t))+1,系统的时变阻尼因子设定为b=0.6sin(0.05t)+2.5。图3、图4、图5、图6、图7、图8、图9和图10分别对应为本实施例处理时变非线性质量弹簧阻尼系统运动控制时x(ti+1)、y(ti+1)、m(ti+1)、k(ti+1)、b(ti+1)、fMSD(ti+1)、z(ti+1)、zd(ti+1)和|e(ti+1)|的示意图。从上述仿真图可知,实际系统输出z趋于期望输出zd,说明本实施例可以有效地实现对时变非线性质量弹簧阻尼系统的运动控制,解决现有技术和方法无法有效处理同时考虑时变和非线性两个特点的质量弹簧阻尼系统的运动控制问题。 [0070] 附图中描述位置关系的用语仅用于示例性说明,不能理解为对本专利的限制; |