CN106919048B - 一种auv推进器状态检测和推力曲线修正方法 - Google Patents
一种auv推进器状态检测和推力曲线修正方法 Download PDFInfo
- Publication number
- CN106919048B CN106919048B CN201710094816.9A CN201710094816A CN106919048B CN 106919048 B CN106919048 B CN 106919048B CN 201710094816 A CN201710094816 A CN 201710094816A CN 106919048 B CN106919048 B CN 106919048B
- Authority
- CN
- China
- Prior art keywords
- thrust
- curve
- propeller
- current
- detection
- 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.)
- Active
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Testing Of Devices, Machine Parts, Or Other Structures Thereof (AREA)
Abstract
本发明提供的是一种AUV推进器状态检测和推力曲线修正方法。首先是螺旋桨敞水试验获得推进器相关曲线,包括控制信号推力曲线、转速推力曲线、电流推力曲线、转速电流曲线,以此为标准进行推进器状态检测及推力曲线修正。其次是推进器状态检测,实际工作时利用电流传感器和转速传感器实测电流和实测转速,以及测试环境下转速与电流关系进行推进器状态检测。最后是推进器推力曲线修正,当达到推进器推力曲线修正条件时,进行局部修正和全局修正判断,替换掉原控制信号下的推力值,拟合获得推力曲线。本发明可实现对推进器状态的实时检测,并能实现推进器推力曲线的快速修正。
Description
技术领域
本发明涉及的是一种水下航行器控制方法,具体地说是一种AUV推进器状态检测及推力曲线修正方法。
背景技术
智能水下机器人(AUV)是船舶与海洋工程和机器人技术的学科交叉领域,在世界各国都得到了广泛的重视。AUV现已广泛应用于水域勘察、中继通讯等,并被应用于海底生物资源探查、矿产资源采样、海底地形勘测、沉物打捞、地震地热活动监测、海洋环境监测等。水下航行器在海洋资源开发以及水下安全中保障中具有非常重要的地位。
目前现有的推进器直接故障检测方法,采用SISO结构建立每个推进器电压模型及电流模型,输入为推进器的控制信号,输出分别为推进器正常运转情况下的理论电压值及电流值。实际工作时,通过对比不同输入信号下的实测电流(或转速等信息)与正常电流,进行推进器故障诊断。
由于推进器测试条件的限制如测试水池开阔程度、水深等,造成常规的螺旋桨敞水试验获得的结果与实际应用的效果差别较大,推进器推力曲线较测试时有所偏移或变形,造成常规推进器直接故障检测方法出现误判的几率大大增加。
发明内容
本发明的目的在于提供一种能实现对推进器状态的实时检测,并能实现推进器推力曲线的快速修正的AUV推进器状态检测和推力曲线修正方法。
本发明的目的是这样实现的:
(1)、取系列特征控制信号,测试推进器在每一控制信号下的推力,并通过转速传感器和电流传感器测得每一控制信号下的转速、电流信息,拟合获得获得控制信号推力曲线、转速推力曲线、电流推力曲线、转速电流曲线,以敞水实验时推力、转速、电流三者的相互关系作为推进器状态检测及推力曲线修正的标准;
(2)、实际工作时,电流传感器所测电流代入电流转速关系式获得应当转速,转速传感器实测转速与应当转速作差获得转速差异值,将转速差异值与预设的阈值进行比较,进行推进器状态检测,若超过所述阈值,则推进器转态异常、停止工作;
(3)、推进器正常状态下,将实测转速和实测电流代入转速推力曲线和电流推力关系曲线,求得应当推力与预设的阈值进行比较,若超过所述阈值,进行局部修正和全局修正判断,若为局部修正,将此控制信号下的推力值替换为应当推力,拟合获得推力曲线;若为全局修正,则取部分特征控制信号进行测试,将各控制信号下的推力值均替换为应当推力,并利用NURBS曲线进行拟合获得推力曲线。
本发明还可以包括:
1、所述拟合获得推力曲线是采用logistic模型进行拟合,S型曲线首尾平缓的变化趋势符合推进器特性,通过拟合曲线预测推进器零推力点,建立包含死区的推进器推力曲线。
2、NURBS曲线拟合所得推力曲线表示为:
式中:ui是控制点矢量、即所选取的特征控制信号,wi是控制点相应的权因子,Ni,k(u)是k次B样条基函数。
本发明提出了一种推进器状态检测和推力曲线修正方法,可实现对推进器状态的实时检测,并能实现推进器推力曲线的快速修正。
本发明包括推进器状态检测和推力曲线修正方法。首先是螺旋桨敞水试验获得推进器相关曲线,包括控制信号推力曲线、转速推力曲线、电流推力曲线、转速电流曲线,以此为标准进行推进器状态检测及推力曲线修正。其次是推进器状态检测,实际工作时利用电流传感器和转速传感器实测电流和实测转速,以及测试环境下转速与电流关系进行推进器状态检测。最后是推进器推力曲线修正,当达到推进器推力曲线修正条件时,进行局部修正和全局修正判断,替换掉原控制信号下的推力值,拟合获得推力曲线。本发明可实现对推进器状态的实时检测,并能实现推进器推力曲线的快速修正。
附图说明
图1是本发明的系统结构图;
图2是本发明的流程图。
具体实施方式
下面结合附图举例对本发明做更详细地描述:
结合图1,本发明的系统结构主要包括包括控制器、推进器、AUV载体、推进器状态传感器(转速传感器和电流传感器)、推进器状态检测模块、推进器推力曲线修正模块。其中推进器检测模块根据电流传感器和转速传感器实测电流Ip和实测转速np,以及测试环境下转速与电流关系q(I)进行推进器状态检测,若检测推进器状态异常,立即停止。推进器状态正常时,进行推进器推力曲线修正,若达到修正条件进入推进器推力曲线修正模块,根据实测电流Ip和实测转速np,以及测试环境下电流推力曲线h(I)和转速推力曲线g(n),进行推进器推力曲线修正,替换掉原控制信号下的推力值,拟合获得推力曲线。推进器根据控制器输出u产生推力τ驱动AUV运动。
本发明的详细实现方法为:
(1)螺旋桨敞水试验获得推进器相关曲线,取系列特征控制信号u,测试推进器在每一控制信号下的推力Tf,并通过转速传感器和电流传感器测得每一控制信号下的转速n、电流I信息,获得控制信号推力散点图、转速推力散点图、电流推力散点图、转速电流散点图。
Tf=f(u1,u2,u3…um)
Tf=g(n1,n2,n3…nm)
Tf=h(I1,I2,I3…Im)
n=q(I)
式中,u1…um表示控制信号,n1…nm,I1…Im表示实测转速和实测电流。
根据推进器自身特性以及散点图信息,信号推力关系采用logistic模型进行曲线拟合。通过选择合适的参数k,a,b,c,可对推进器推力进行准确的建模,通过拟合曲线预测推进器零推力点,建立包含死区的推进器推力曲线。
式中:k1,a1,b1,c1为信号推力曲线相关参数
利用Matlab拟合工具箱,进行转速推力曲线、电流推力曲线、转速电流曲线拟合,发现用四次多项式拟合比较合适。则其可表示为:
Tf=g(n)=a1×n4+a2×n3+a3×n2+a4×n+a5
Tf=h(I)=m1×I4+m2×I3+m3×I2+m4×I+m5
n=q(I)=d1×I4+d2×I3+d3×I2+d4×I+d5
式中:a1,a2,a3,a4,a5为转速推力曲线相关参数,m1,m2,m3,m4,m5为电流推力曲线相关参数,d1,d2,d3,d4,d5为转速电流曲线相关参数。
以敞水实验时推力、转速、电流三者的相互关系作为推进器状态检测及推力曲线修正的标准。
(2)实际工作时,控制器输出控制信号u发送给推进器,推进器以一定转速工作。推进器运转时,状态传感器包括转速传感器和电流传感器测得推进器实时状态,即实时转速np和实时电流Ip,将实时电流代入转速电流曲线q(I)获得应当转速nr。应当转速nr与实测转速np作差获得转速差异值ne与预设的阈值nd进行比较,进行推进器状态检测,若超过阈值,推进器转态异常,停止工作。
nr=q(Ip)
ne=|nr-np|
式中:ne为转速差异值,nd为预设的阈值。
推进器正常状态下,将实测转速np和实测电流Ip代入转速推力曲线g(n)和电流推力曲线h(I),求得应当推力Tn和TI。
Tn=g(np)
TI=h(Ip)
控制器输出u代入f(u)所得Tm与作差得Te,Te与预设的阈值Td进行比较,若超过阈值,进行控制信号推力曲线f(u)修正。
式中:Te为推力差异值,Tm为控制器输出u代入f(u)所得,Td为预设的阈值。
进行局部修正和全局修正判断。
式中:Te为推力差异值,Tq为预设的阈值。
若为局部修正,将此控制信号下的推力值替换为应当推力,拟合获得推力曲线。
式中:k2,a2,b2,c2为logistic模型相关参数。
若为全局修正,则取部分特征控制信号进行测试,将各控制信号下的推力值均替换为应当推力,并利用NURBS曲线进行拟合获得推力曲线。
式中:ui是控制点矢量,即所选取的特征控制信号,wi是控制点相应的权因子。Ni,k(u)是k次B样条基函数,是由节点矢量U=[u0,u1,…,un+k+1]按照以下的公式定义:
式中:Ni,k(u)的双下标k表示次数,第一下标i表示序号。
图2表述了本发明的系统流程图。具体实现步骤如下:
(1)电流传感器实测电流Ip代入电流转速关系式q(I)获得应当转速nr。
(2)实测转速np与应当转速nr作差获得转速差异值ne。
(3)转速差异值ne与预设的阈值nd进行比较,进行推进器状态检测,若超过阈值,推进器转态异常,停止工作。
(4)推进器正常状态下,将实时转速np和实时电流Ip代入转速推力曲线g(n)和电流推力关系曲线h(I),求得应当推力Tn和TI。
(5)控制器输出u代入f(u)所得Tm与作差得Te,Te与预设的阈值Td进行比较,若超过阈值,进行控制信号推力曲线f(u)修正。
(6)Te与预设的阈值Tq进行比较,若超过阈值,进行全局修正,否则进行局部修正。
(7)若为局部修正,将此控制信号下的推力值替换为应当推力,拟合获得推力曲线。
(8)若为全局修正,则取部分特征控制信号进行测试,将各控制信号下的推力值均替换为应当推力,并利用NURBS曲线进行拟合获得推力曲线。
Claims (2)
1.一种AUV推进器状态检测和推力曲线修正方法,其特征是:
(1)、取系列特征控制信号,测试推进器在每一控制信号下的推力,并通过转速传感器和电流传感器测得每一控制信号下的转速、电流信息,拟合获得获得控制信号推力曲线、转速推力曲线、电流推力曲线、转速电流曲线,以敞水实验时推力、转速、电流三者的相互关系作为推进器状态检测及推力曲线修正的标准;
(2)、实际工作时,电流传感器所测电流代入电流转速关系式获得应当转速,转速传感器实测转速与应当转速作差获得转速差异值,将转速差异值与预设的阈值进行比较,进行推进器状态检测,若超过所述阈值,则推进器转态异常、停止工作;
(3)、推进器正常状态下,将实测转速np和实测电流Ip代入转速推力曲线g(n)和电流推力曲线h(I),求得应当推力Tn和TI,
Tn=g(np)
TI=h(Ip)
控制器输出u代入f(u)所得Tm与作差得Te,Te与预设的阈值Td进行比较,若超过阈值,进行控制信号推力曲线f(u)修正;
式中:Te为推力差异值,Tm为控制器输出u代入f(u)所得,Td为预设的阈值;
进行局部修正和全局修正判断,
式中:Tq为预设的阈值,
若为局部修正,将此控制信号下的推力值替换为应当推力,拟合获得推力曲线,
式中:k2,a2,b2,c2为logistic模型相关参数;
若为全局修正,则取部分特征控制信号进行测试,将各控制信号下的推力值均替换为应当推力,并利用NURBS曲线进行拟合获得推力曲线,ui是控制点矢量即所选取的特征控制信号,wi是控制点相应的权因子,Ni,k(u)是k次B样条基函数。
2.根据权利要求1所述的AUV推进器状态检测和推力曲线修正方法,其特征是所述拟合获得推力曲线是采用logistic模型进行拟合,S型曲线首尾平缓的变化趋势符合推进器特性,通过拟合曲线预测推进器零推力点,建立包含死区的推进器推力曲线。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710094816.9A CN106919048B (zh) | 2017-02-22 | 2017-02-22 | 一种auv推进器状态检测和推力曲线修正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710094816.9A CN106919048B (zh) | 2017-02-22 | 2017-02-22 | 一种auv推进器状态检测和推力曲线修正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106919048A CN106919048A (zh) | 2017-07-04 |
CN106919048B true CN106919048B (zh) | 2019-09-27 |
Family
ID=59454388
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710094816.9A Active CN106919048B (zh) | 2017-02-22 | 2017-02-22 | 一种auv推进器状态检测和推力曲线修正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106919048B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109164792B (zh) * | 2018-11-01 | 2020-06-09 | 上海海事大学 | 一种无人潜水器模型预测容错跟踪控制方法 |
CN110161858B (zh) * | 2019-05-28 | 2022-05-20 | 哈尔滨工程大学 | 一种自然能驱动无人艇用面向螺旋桨减震的航速控制方法 |
CN110132627A (zh) * | 2019-05-28 | 2019-08-16 | 上海海事大学 | 一种推进器的故障诊断方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102642607A (zh) * | 2012-05-08 | 2012-08-22 | 徐忠斌 | 旋轨来复式推进器 |
CN102707625A (zh) * | 2012-06-01 | 2012-10-03 | 哈尔滨工程大学 | 一种基于推力分配管理的动力定位船推力分配方法 |
CN103823372A (zh) * | 2014-02-24 | 2014-05-28 | 中国船舶重工集团公司第七○二研究所 | 海洋工程装备动力定位系统的多推进器推力分配方法 |
WO2015028985A1 (en) * | 2013-08-30 | 2015-03-05 | DO', Tiziano | Naval unit able to remain and move submerged and on the surface |
CN105643626A (zh) * | 2016-03-08 | 2016-06-08 | 哈尔滨工程大学 | 一种基于双重判据的水下机器人推力优化分配方法 |
CN105843233A (zh) * | 2016-04-11 | 2016-08-10 | 哈尔滨工程大学 | 一种基于非线性观测器的自主水下航行器运动控制方法 |
EP3107806A2 (en) * | 2014-02-19 | 2016-12-28 | CGG Services SA | Method and autonomous underwater vehicle able to maintain a planned arrangement |
-
2017
- 2017-02-22 CN CN201710094816.9A patent/CN106919048B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102642607A (zh) * | 2012-05-08 | 2012-08-22 | 徐忠斌 | 旋轨来复式推进器 |
CN102707625A (zh) * | 2012-06-01 | 2012-10-03 | 哈尔滨工程大学 | 一种基于推力分配管理的动力定位船推力分配方法 |
WO2015028985A1 (en) * | 2013-08-30 | 2015-03-05 | DO', Tiziano | Naval unit able to remain and move submerged and on the surface |
EP3107806A2 (en) * | 2014-02-19 | 2016-12-28 | CGG Services SA | Method and autonomous underwater vehicle able to maintain a planned arrangement |
CN103823372A (zh) * | 2014-02-24 | 2014-05-28 | 中国船舶重工集团公司第七○二研究所 | 海洋工程装备动力定位系统的多推进器推力分配方法 |
CN105643626A (zh) * | 2016-03-08 | 2016-06-08 | 哈尔滨工程大学 | 一种基于双重判据的水下机器人推力优化分配方法 |
CN105843233A (zh) * | 2016-04-11 | 2016-08-10 | 哈尔滨工程大学 | 一种基于非线性观测器的自主水下航行器运动控制方法 |
Non-Patent Citations (1)
Title |
---|
潜器全方位推进器主轴转速鲁棒H∞控制器设计;刘胜,等;《电机与控制学报》;20090331;第13卷(第2期);第276-286页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106919048A (zh) | 2017-07-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106919048B (zh) | 一种auv推进器状态检测和推力曲线修正方法 | |
Odgaard et al. | Observer based detection of sensor faults in wind turbines | |
CN109359557B (zh) | 一种基于迁移学习的sar遥感图像舰船检测方法 | |
CN105446821B (zh) | 一种基于改进神经网络的智能水下机器人推进器故障诊断方法 | |
CN205540126U (zh) | 一种水下环境监测机器人 | |
Simani et al. | Data—Driven approach for wind turbine actuator and sensor fault detection and isolation | |
CN104075734B (zh) | 水下组合导航故障智能诊断方法 | |
Dalheim et al. | A computationally efficient method for identification of steady state in time series data from ship monitoring | |
CN113139659A (zh) | 基于数字孪生的水利监测方法及系统 | |
CN115795401B (zh) | 海洋牧场全要素监测传感器多数据融合系统 | |
CN109739108A (zh) | Auv运动控制系统硬件在环测试仿真系统及其工作方法 | |
CN104252575B (zh) | 一种基于行为的uuv推进操纵系统异常辨识方法 | |
CN103605168B (zh) | 一种海底多金属硫化物综合信息快速找矿方法 | |
CN115118197A (zh) | 一种auv推进器系统故障诊断方法 | |
CN105867165B (zh) | 基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系统 | |
CN116243683B (zh) | 基于转矩和多头自编码器的推进系统故障诊断方法 | |
Cao et al. | Experimental research on submarine cable monitoring method based on MEMS sensor | |
Filaretov et al. | The new approach for synthesis of diagnostic system for navigation sensors of underwater vehicles | |
Wang et al. | Towards data-driven identification and analysis of propeller ventilation | |
CN116186609A (zh) | 一种基于lstm的载人潜水器传感器故障数据增强方法 | |
Perera et al. | Digitalization of seagoing vessels under high dimensional data driven models | |
CN116147883A (zh) | 一种基于浮标观测数据的海洋内波检测方法 | |
Perera et al. | Visualization of relative wind profiles in relation to actual weather conditions of ship routes | |
Perera et al. | Visual analytics in ship performance and navigation information for sensor specific fault detection | |
CN113888380A (zh) | 一种人员落水轨迹预测方法、装置、设备和介质 |
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 |