法律状态公告日
法律状态信息
法律状态
2017-07-11
授权
授权
2015-07-01
实质审查的生效 IPC(主分类):G05B13/04 申请日:20150130
实质审查的生效
2015-06-03
公开
公开
技术领域
本发明涉及的是一种自主式水下机器人推进器故障诊断、容错控制方法。
背景技术
随着陆地资源日渐减少,人类开发海洋的步伐越来越快。自主式水下机器人(AUV: Autonomous Underwater Vehicle)是目前唯一能够在无人情况下在深海进行探测、开发的载体, 一直受到国内外研究人员的高度重视。推进器是AUV最重要的执行部件且负荷最重,一旦 其出现故障直接影响AUV的安全性。对AUV推进器状态进行故障诊断,是提高AUV安全 性的重要技术手段。
由于外部干扰的影响,直接采用传感器采集到的AUV控制信号和状态信号进行故障诊 断效果不佳,存在容易误检和漏检的问题。目前的外部干扰抑制方法能够有效抑制AUV信 号中所含外部干扰,但在抑制的同时也极易造成过抑制问题,即对于故障诊断极为重要的信 号特征也被抑制,影响故障诊断的准确性。随机共振理论是在研究古气象冰川问题时提出的, 它是指在一个非线性双稳系统中,当仅在周期信号的驱动下,不足以使系统输出在两个稳态 间进行跃迁,但在噪声的协助下,系统输出会按信号频率在两稳态间进行切换,从而达到抑 制噪声并强化周期信号的效果。
为实现信号的随机共振,传统方法通常采用向原信号中添加噪声或固定系统一个结构参 数并按固定步长调节另一个结构参数的自适应调整策略。但在研究AUV信号随机共振的过 程中发现,AUV信号中外部干扰与真实故障信号耦合在一起难以剥离,添加噪声的方法难以 实现其随机共振;固定一个参数调整另一个参数的调整策略能够实现AUV信号随机共振, 但由于只对单一参数进行自适应调整,忽略了参数之间的交互作用,存在随机共振系统参数 选取缺乏合理的理论依据以及难以实现最优随机共振效果的问题。
发明内容
本发明的目的在于提供一种能抑制外部干扰、增强故障信号特征、提高故障诊断的准确 性的基于粒子群优化单稳态自适应随机共振的自主式水下机器人信号处理方法。
本发明的目的是这样实现的:
(1)首先,对自主式水下机器人采集到的数据进行滑动窗处理,当采集到数据长度为L 的传感器和控制器信号后开始检测,当再次采集到新的数据后,舍弃原数组第一个数据并将 新采集回来的数据放在原数组的末尾,始终保持数据长度为L=250~500;
(2)采用粒子群优化算法对单稳态随机共振系统结构参数进行优化,首先进行种群初始 化,具体方法为:设置单稳系统结构参数a、b的搜索范围在[0,7]区间,Tmax=100,随机初始 化N=50个粒子组成一个种群;
(3)采用式所示的单稳态随机共振模型处理自主式水下机器人 信号,式中x(t)为单稳随机共振系统输出信号,为中x(t)的导数,s(t)为步骤(1)所述的 自主式水下机器人控制信号和状态信号,a、b为单稳随机共振系统结构参数;
(4)采用互相关系数R作为适应度函数来评价粒子的个体适应度,R值越大则粒子的适 应性越好;R由式
(5)采用式Vi(t+1)=w×Vi(t)+c1×R1×(Pi(t)-Xi(t))+c2×R2×(G(t)-Xi(t))所示的方式更 新所有粒子的分形速度和位置,其中:t为当前迭代次数,i代表种群中第i个粒子,Xi(t)、 Vi(t)分别为第t次迭代时第i个粒子的位置和飞行速度,Vi(t+1)为第t+1次迭代时第i个粒子 的飞行速度,Vi(t)为第t次迭代时第i个粒子的飞行速度,c1=2和c2=2为学习因子,R1和R2为介于[0,1]之间相互独立均匀分布的随机数,Pi(t)为经过t次迭代第i个粒子迄今为止搜索到 的最优解,G(t)为经过t次迭代整个种群所有粒子迄今为止搜索到的最优解,w为惯性权重、 由式w(t)=wmax-(wmax-wmin)×t/Tmax求得,式中wmax=25为惯性权重的上限,wmin=1为惯性 权重的下限,t为当前迭代次数,Tmax为最大迭代次数,得到更新后的粒子飞行速度Vi(t+1)后, 带入式Xi(t+1)=Xi(t)+Vi(t+1),式中Xi(t+1)为第t+1次迭代时第i个粒子的位置,Xi(t)为 第t次迭代时第i个粒子的位置。经上述计算后,得到更新后粒子的位置和飞行速度;
(6)判断是否符合终止条件,当满足下列条件中的任何一个时,迭代终止:1.进化代数 达到设定的最大阈值Tmax;2.两代之间的最优适应度值之差小于预设精度,满足上述两个条件 任何一个则迭代优化过程终止,进入下一步骤;两个条件均不满足则回到步骤(3)继续进行 迭代优化;
(7)经粒子迭代更新优化后,得到最优结构参数a和b的值并输出给单稳随机共振系统;
(8)采用最优结构参数a和b的单稳态随机共振:根据步骤(7)得到的最优结构参数 a和b的值,固化步骤(3)所述单稳态随机共振系统的结构参数值,对自主式水下机器人控 制信号和状态信号进行随机共振处理。
本发明根据AUV信号的非周期特性,采用单稳态随机共振系统实现其随机共振,采用 粒子群优化算法实现随机共振系统结构参数的自适应优化调整,构成一种新型的基于粒子群 优化单稳态自适应随机共振的自主式水下机器人信号处理方法,有效解决传统方法难以实现 AUV信号最佳随机共振效果问题,以抑制外部干扰,增强故障信号特征,进而提高故障诊断 的准确性。
本发明与现有技术相比的有益效果主要体现在:与现有传统双稳态自适应随机共振方法 相比,本发明提出了一种新型的单稳态自适应随机共振实现方法,该方法有效解决了传统方 法仅对单一参数进行调节,缺乏理论依据的问题;解决了传统方法由于忽略了参数之间的交 互作用,难以实现最优随机共振效果的问题。经随机共振处理后的AUV信号在抑制外部干 扰的同时增强了故障信号特征,为故障诊断提供更为准确的AUV状态信息。
附图说明
图1为本发明方法的流程图。
图2为推进器推力损失程度为20%的AUV多普勒信号时域曲线。
图3为本发明方法的最优结构参数收敛曲线。
图4为推力损失程度为20%的AUV多普勒信号经本发明方法处理后时域曲线。
图5为传统单参数调节自适应随机共振方法实现的随机共振效果。
具体实施方式
下面结合附图举例对本发明做更详细的描述。
结合图1,本发明的基于粒子群优化单稳态自适应随机共振的自主式水下机器人信号处 理方法,其具体实施步骤如下:
1、首先,对原始数据采用滑动窗进行截取,原始数据如图2所示。当采集到数据长度为 L=300的多普勒数据后启动检测算法,当再次采集到新的数据后,舍弃原数组第一个数据并 将新采集回来的数据放在原数组的末尾,始终保持数据长度为L。
2.采用粒子群优化算法对单稳态随机共振系统结构参数进行优化,首先进行种群初始化, 具体方法为:设置单稳系统结构参数a、b的搜索范围在[0,7]区间,Tmax=100,随机初始化N=50 个粒子组成一个种群。
3.采用如下式所示的单稳态随机共振模型处理AUV信号:式 中x(t)为单稳随机共振系统输出信号,为其导数,s(t)为步骤(1)所述的自主式水下机器 人控制信号和状态信号,a、b为单稳随机共振系统结构参数;
4.采用互相关系数R作为适应度函数来评价粒子的个体适应度,R值越大则粒子的适应 性越好。互相关系数R由下式求得:式中其中:R为所求互相关系数,s为AUV纵向速度原始信号,x为单稳系统输出 信号,L为AUV信号数据长度,j代表取L个数据中的第j个数据。
5.采用如下式所示的方式更新所有粒子的分形速度和位置: Vi(t+1)=w×Vi(t)+c1×R1×(Pi(t)-Xi(t))+c2×R2×(G(t)-Xi(t)),式中:t为当前迭代次数,i 代表种群中第i个粒子,Xi(t)、Vi(t)分别为第t次迭代时第i个粒子的位置和飞行速度,Vi(t+1) 为第t+1次迭代时第i个粒子的飞行速度,Vi(t)为第t次迭代时第i个粒子的飞行速度,c1=2 和c2=2为学习因子,R1和R2为介于[0,1]之间相互独立均匀分布的随机数,Pi(t)为经过t次迭 代第i个粒子迄今为止搜索到的最优解,G(t)为经过t次迭代整个种群所有粒子迄今为止搜索 到的最优解,w为惯性权重,由下式求得:w(t)=wmax-(wmax-wmin)×t/Tmax,式中wmax=25为 惯性权重的上限,wmin=1为惯性权重的下限,t为当前迭代次数,Tmax为算法的最大迭代次数。 得到更新后的粒子飞行速度Vi(t+1)后,带入下式:Xi(t+1)=Xi(t)+Vi(t+1),式中Xi(t+1)为 第t+1次迭代时第i个粒子的位置,Xi(t)为第t次迭代时第i个粒子的位置。经上述计算后, 得到更新后粒子的位置和飞行速度;
6.判断是否符合终止条件,当满足下列条件中的任何一个时,迭代终止:1.进化代数达到 设定的最大阈值Tmax;2.两代之间的最优适应度值之差小于预设精度。满足上述两个条件任何 一个则迭代优化过程终止,进入下一步骤;两个条件均不满足则回到步骤(3)继续进行迭代 优化;本发明方法最终所得的最优结构参数收敛曲线如图3所示,从图3中可以看出,本发 明方法最终实现的随机共振效果R=0.99998。
7.经上述步骤粒子迭代更新优化后,得到最优结构参数a和b的值,a=7,b=2.4493,并 输出给单稳随机共振系统;
8.采用最优结构参数a和b的单稳态随机共振:根据步骤(7)得到的最优结构参数a和 b的值,固化步骤(3)所述单稳态随机共振系统的结构参数值,对自主式水下机器人控制信 号和状态信号进行随机共振处理。推力损失程度为20%的AUV多普勒信号经本发明方法处 理后时域曲线如图4所示。
图5为传统单参数调节自适应随机共振方法实现的随机共振效果。从图5中可以看出, 固定结构参数b=1,按固定步长0.6对AUV左主推进器推力损失20%故障实现随机共振时, 在结构参数a=3.6,b=1处实现了随机共振,随机共振效果为R=0.9295。本发明方法相对传统 方法随机共振效果提高了(0.99998-0.9295)/0.9295=7.58%,说明本发明方法比传统方法实现随 机共振效果更佳。
综上所述,本发明首先采用滑动窗方法对原始数据进行截取,然后采用粒子群优化算法 对单稳态随机共振系统的结构参数进行优化,利用优化后的结构参数构建的单稳随机共振系 统处理AUV信号,实现自主式水下机器人的单稳态自适应随机共振。最终可一直外部随机 干扰并增强故障信号特征,是一种新型、有效的自主式水下机器人信号处理实现方法。
机译: 基于贝叶斯自适应共振的多目标多模粒子群优化方法
机译: 水下机器人,用于感知和避免障碍的水下机器人的障碍检测器以及使用水下机器人进行感知和避免障碍的方法,其能够基于与食物的接触来精确地感测障碍物
机译: 水下机器人的自学式自主导航系统和方法