CN114646949B - 一种分裂波束声呐校正用标准球位置自适应控制方法 - Google Patents
一种分裂波束声呐校正用标准球位置自适应控制方法 Download PDFInfo
- Publication number
- CN114646949B CN114646949B CN202210238061.6A CN202210238061A CN114646949B CN 114646949 B CN114646949 B CN 114646949B CN 202210238061 A CN202210238061 A CN 202210238061A CN 114646949 B CN114646949 B CN 114646949B
- Authority
- CN
- China
- Prior art keywords
- matrix
- correction
- standard ball
- paying
- length
- 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
- 238000000034 method Methods 0.000 title claims abstract description 29
- 239000011159 matrix material Substances 0.000 claims abstract description 38
- 230000011218 segmentation Effects 0.000 claims description 7
- 239000013598 vector Substances 0.000 claims description 6
- 230000003044 adaptive effect Effects 0.000 claims 1
- 230000001351 cycling effect Effects 0.000 abstract 1
- 238000011835 investigation Methods 0.000 description 4
- 241000251468 Actinopterygii Species 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 201000004569 Blindness Diseases 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/52—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S15/00
- G01S7/52004—Means for monitoring or calibrating
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明属于分裂波束声呐校正领域,涉及一种分裂波束声呐校正用标准球位置自适应控制方法。步骤如下:输入电机位置、深度位置以及标准球预置位置;计算放线长度矩阵;根据矩阵精度选择矩阵插值以及矩阵寻址方法;电机实际放线;读取放线后标准球位置;计算当前标准球位置与预置位置距离并选取合适步长因子;判断步长因子取值,若不为0,则从判断矩阵精度开始不断循环;若为0,则标准球达到预置位置。本方法实现了以智能化方式调整标准球位置的目的,摆脱了先前的人工调整方式,降低了声呐校正工作的人力投入以及时间投入。
Description
技术领域
本发明属于分裂波束声呐校正领域,涉及一种分裂波束声呐校正用标准球位置自适应控制方法。
背景技术
在过去的几十年里,声学调查方法已经成为估计鱼类种群丰度中使用最广泛的方法之一,与其它渔业资源调查方法相比,渔业水声学方法因其探测范围广、调查效率高、对调查区域的生态环境没有损害以及对鱼群定位较为准确等优点,为世界渔业发达国家所广泛采用。但是渔业资源探测中有一个很重要的参数是声纳换能器的指向性,即声呐向各个方向发射以及接收声波能力的强弱,随着时间的推移,这一参数会发生变化,所以对它的校正尤为重要。目前的校正采用国际上的标准目标方法,即利用已知目标强度的标准球对声呐进行校正,即在船体安装传感器的情况下,球体由船一侧的两条线和另一侧的第三条线悬挂,三条线由电机控制,通过控制电机进而控制三条线的放线长度,使小球遍历声呐波束的每一个位置,通过实际测量的目标与已知目标强度的标准球进行比对并纠正,最终达到同一物体在声束各个方向的目标强度相同的目的。现有的校正工作采用人眼识别球体位置,手动调整放线长度的工作方式,整个校正过程大约需要5-9个小时,因此投入的时间成本非常大。
发明内容
为了解决上述问题,本发明提供了一种分裂波束声呐校正用标准球位置自适应控制方法。
本发明采用如下技术方案:
一种分裂波束声呐校正用标准球位置自适应控制方法,包括以下几个步骤:
步骤一:获取三台步进电机放线位置平面坐标分别为(x1,y1),(x2,y2),(x3,y3)以及标准球预置深度depth,标准球预置位置(x0,y0);
步骤二:计算理论放线长度矩阵H1[L1],H2[L2],H3[L3],其中L1,L2,L3为放线长度;
步骤三:根据矩阵行列步长选择矩阵元素寻址以及矩阵插值方法计算实际放线长度;
步骤四:根据求得放线长度实际放线;
步骤五:获取标准球现位置坐标:(x_cur,y_cur);
步骤六:计算现位置坐标与目标位置坐标平面距离S以及x轴带符号偏移量以及y轴带符号偏移量;
x_ex=x_cur-x0;
y_ex=y_cur-y0;
其中;x_ex和y_ex分别代表横纵坐标偏移量;
步骤八:根据梯度下降理论,设置一个取值在[0,1]之间的等步长因子向量[step],step为因子取值;最大值视实际条件选取,设为step_max,最小值为step_min=0,步长取值应适中;设置距离分段区间[0,s1)[s1,s2).....[sn-1,sn],分段区间数取与等步长因子数量相同;
将分段区间与等步长因子向量中的元素一一对应,例:若S∈[sn-1,sn],则step=step_max;
步骤九:判断求得的S所处的分段区间并找到对应的因子值
步骤十:根据已经得到的因子值,求出矩阵纠正坐标(cor_x,cor_y):
(cor_x,cor_y)=(x0-step×x_ex,y0-step×y_ex)
步骤十一:对矩阵纠正坐标再进行插值或矩阵寻址,不断重复以上流程,判断S小于允许误差,则标准球到达目标位置。
本发明的优势在于:
本发明充分考虑现场实际情况,结合梯度下降理论,实现了声呐校正工作的智能化模式,摆脱了一直以来的人工调整方式,节省了大量的时间成本以及人力成本,利用科学方法解决实际工程问题,具有很好的前瞻性以及推广价值
附图说明
图1是海上实际校正模式图;
图2是声呐工作模式以及标准球位置捕捉信息图;
图3是本方法的基本流程图;
图4是放线长度矩阵模式图(以x2=18,y2=25,depth=30为例);
图5是本方法核心方法图解。
具体实施方式
下面将结合附图对本发明做进一步详细说明
如图1,本发明应用的现场条件是处于海上的船体,由三条线吊着一个目标即标准球,三条线放线长度由各自的步进电机控制;
如图2,船体下方的声呐向水下垂直发射锥形声束,通过控制步进电机旋转角度控制放线长度进而控制标准球所处的位置,最终使标准球遍历声束中任何一个横截面;
但是实际工作中,由于环境的不确定性、人工调节的盲目性以及校正覆盖面积较大等原因,校正工作持续的时间很长。因此在可能的条件下,采用智能化方式利用计算机代替人工完成实际条件下的校正工作是有积极意义的;
结合图4,本发明的具体步骤如下:
步骤一:如图1,将三台步进电机分别标号为①,②,③,三台步进电机在平面构成等腰三角形,①处于等腰三角形顶点,②,③各置其余两点,等腰三角形规格视船体规模而定;
步骤二:如图1,定坐标轴,其中原点取在①向②,③连线投影的中心点处,y轴延②,③连线方向指向②,x轴取y轴顺时针旋转90°方向;
步骤三:如图1,获取三台步进电机放线位置平面坐标分别为(x1,y1),(x2,y2),(x3,y3)以及标准球预置深度depth,标准球预置位置(x0,y0),可知x1=-x2=-x3,y1=0,y2=-y3;
步骤三:如图5,计算理论放线长度矩阵H1[L1],H2[L2],H3[L3],其中L1,L2,L3为放线长度;
步骤四:根据矩阵行列步长选择矩阵元素寻址以及矩阵插值方法,描述如下:
若预置目标位置坐标点位置精度高于矩阵精度,则采用插值方式,插值方式描述:
本发明中将插值符号取为“griddata”,以第一条线放线长度为例
L1H=griddata(x0,y0);
其中:L1H为标准球预置位置为(x0,y0)时第一条线的放线长度;
当矩阵精度满足目标位置坐标精度要求,则采用矩阵寻址方式,矩阵寻址方法描述:
设矩阵为m×m方阵,则根据目标点位置确定矩阵坐标为
其中round代表四舍五入函数;
则三条线的放线长度分别为:
步骤五:根据求得放线长度实际放线;
步骤六:获取标准球现位置坐标:(x_cur,y_cur);
步骤七:计算现位置坐标与目标位置坐标平面距离S以及x轴带符号偏移量以及y轴带符号偏移量;
x_ex=x_cur-x0a;
y_ex=y_cur-y0;
其中:x_ex和y_ex分别代表横纵坐标偏移量;
步骤八:根据梯度下降理论,设置一个取值在[0,1]之间的等步长因子向量[step],step为因子取值,最大值视实际条件选取,设为step_max,最小值为step_min=0,步长取值应适中;设置距离分段区间[0,s1)[s1,s2).....[sn-1,sn],分段区间数取与等步长因子数量相同;
将分段区间与等步长因子向量中的元素一一对应,例:若S∈[sn-1,sn],则step=step_max;
步骤九:判断求得的S所处的分段区间并找到对应的因子值;
步骤十:如图2,根据已经得到的因子值,求出矩阵纠正坐标:
(cor_x,cor_y)=(x0-step×x_ex,y0-step×y_ex)
步骤十一:对矩阵纠正坐标再进行插值或矩阵寻址,判断S是否小于允许误差,若大于允许误差,则不断循环以上流程;若小于允许误差,则终止循环,标准球到达目标位置。
Claims (2)
1.一种分裂波束声呐校正用标准球位置自适应控制方法,其特征在于,步骤包括:
步骤一:获取三台步进电机放线位置平面坐标(x1,y1),(x2,y2),(x3,y3)、预置深度depth以及标准球预置位置(x0,y0);
步骤二:计算理论放线长度矩阵H1[L1],H2[L2],H3[L3],其中,L1,L2,L3为放线长度:
步骤三:根据矩阵行列步长选择矩阵元素寻址以及矩阵插值方法计算实际放线长度;
步骤四:根据已经求得的三条线的放线长度,进行放线操作;
步骤五:获取标准球现位置坐标:(x_cur,y_cur);
步骤六:计算现位置坐标与目标位置坐标平面距离S以及x轴带符号偏移量以及y轴带符号偏移量:
x_ex=x_cur-x0;
y_ex=y_cur-y0;
其中,x_ex和y_ex分别代表横纵坐标偏移量;
步骤七:根据梯度下降理论,设置一个取值在[0,1]之间的等步长因子向量[step],step为因子取值,最大值视实际条件选取,设为step_max,最小值为step_min=0,步长取值应适中;
设置距离分段区间[0,s1)[s1,s2).....[sn-1,sn],分段区间数取与等步长因子数量相同,将分段区间与等步长因子向量中的元素对应;
步骤八:判断求得的S所处的分段区间并找到对应的因子值;
步骤九:根据已经得到的因子值,求出矩阵纠正坐标:
(cor_x,cor_y)=(x0-step×x_ex,y0-step×y_ex)
步骤十:对矩阵纠正坐标再进行插值或矩阵寻址,设置允许误差,判断S是否小于允许误差,小于允许误差则标准球到达目标位置,大于允许误差则不断重复从步骤三开始的流程。
2.如权利要求1所述的一种分裂波束声呐校正用标准球位置自适应控制方法,其特征在于,所述的步骤三中,矩阵元素寻址方法具体步骤如下:
设矩阵为m×m方阵,则根据目标点位置确定矩阵坐标为
其中round代表四舍五入函数;则三条线的放线长度分别为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210238061.6A CN114646949B (zh) | 2022-03-11 | 2022-03-11 | 一种分裂波束声呐校正用标准球位置自适应控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210238061.6A CN114646949B (zh) | 2022-03-11 | 2022-03-11 | 一种分裂波束声呐校正用标准球位置自适应控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114646949A CN114646949A (zh) | 2022-06-21 |
CN114646949B true CN114646949B (zh) | 2024-05-21 |
Family
ID=81993810
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210238061.6A Active CN114646949B (zh) | 2022-03-11 | 2022-03-11 | 一种分裂波束声呐校正用标准球位置自适应控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114646949B (zh) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006199294A (ja) * | 2006-04-28 | 2006-08-03 | Tech Res & Dev Inst Of Japan Def Agency | 誘導制御装置、誘導制御システム、母船、誘導制御方法及びプログラム |
CN111880184A (zh) * | 2020-08-04 | 2020-11-03 | 湖南国天电子科技有限公司 | 一种应用于船载侧扫声呐的海底目标定位方法及系统 |
CN112978517A (zh) * | 2021-01-29 | 2021-06-18 | 中国地质调查局西安地质调查中心(西北地质科技创新中心) | 一种地球物理勘探自动收放线装置 |
-
2022
- 2022-03-11 CN CN202210238061.6A patent/CN114646949B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006199294A (ja) * | 2006-04-28 | 2006-08-03 | Tech Res & Dev Inst Of Japan Def Agency | 誘導制御装置、誘導制御システム、母船、誘導制御方法及びプログラム |
CN111880184A (zh) * | 2020-08-04 | 2020-11-03 | 湖南国天电子科技有限公司 | 一种应用于船载侧扫声呐的海底目标定位方法及系统 |
CN112978517A (zh) * | 2021-01-29 | 2021-06-18 | 中国地质调查局西安地质调查中心(西北地质科技创新中心) | 一种地球物理勘探自动收放线装置 |
Non-Patent Citations (2)
Title |
---|
翟春平 ; 刘雨东 ; .聚焦波束形成声图法误差分析.声学技术.2008,(第01期),全文. * |
苟艳妮 ; 王英民 ; 王奇 ; .一种修正的浮标用多波束比幅法测向精度研究.电声技术.2013,(第02期),全文. * |
Also Published As
Publication number | Publication date |
---|---|
CN114646949A (zh) | 2022-06-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108919199B (zh) | 多波束成像声纳稀疏阵列的旁瓣抑制方法、阵列稀疏方法 | |
CN110103217B (zh) | 工业机器人手眼标定方法 | |
CN110246193B (zh) | 工业机器人末端相机在线标定方法 | |
CN115171097B (zh) | 基于三维点云的加工控制方法、系统及相关设备 | |
CN113487721B (zh) | 一种基于三维点云的预制构件自动化识别方法 | |
CN114646949B (zh) | 一种分裂波束声呐校正用标准球位置自适应控制方法 | |
CN111025302A (zh) | 一种智能化船载水声定位装置、系统及定位方法 | |
CN109635486B (zh) | 一种高分辨率三维成像声纳换能器阵列稀疏优化方法 | |
CN109001694B (zh) | 一种动态自适应天线扫描特性模拟方法及系统 | |
CN111722202B (zh) | 一种基于回波强度的反光板位置拟合方法及系统 | |
CN109981195A (zh) | 无线信号强度的处理方法及装置 | |
CN113096058B (zh) | 空间目标多源数据参数化仿真与MixCenterNet融合检测方法 | |
CN117601135A (zh) | 智能砌墙机器人姿态调整方法及系统 | |
CN110109087B (zh) | 一种声纳不规则探测范围显示方法及系统 | |
CN113432572A (zh) | 一种基于三维扫描的复杂结构最优测点规划方法 | |
CN115469015B (zh) | 曲面构件超声自适应检测方法 | |
CN110986782A (zh) | 适用于机械手的标定方法 | |
CN116117815A (zh) | 配网机器人作业工具路径标定方法、控制器、设备及介质 | |
CN115032592A (zh) | 一种换能器阵列的阵形优化方法及换能器阵列 | |
CN106707265B (zh) | 一种声呐扇形图的转换更新方法 | |
CN113848556B (zh) | 基于多波束测深声呐波束图像的水深范围快速提取方法 | |
CN220043563U (zh) | 一种基于声音定位拍照的装置 | |
CN117289251B (zh) | 一种声纳接收角度优化方法及装置 | |
CN114620207B (zh) | 一种水下机器人的推力分配器及推力分配方法 | |
CN115015831B (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 |