CN112666562B - 一种合成孔径声纳运动补偿与成像方法 - Google Patents
一种合成孔径声纳运动补偿与成像方法 Download PDFInfo
- Publication number
- CN112666562B CN112666562B CN202011467799.7A CN202011467799A CN112666562B CN 112666562 B CN112666562 B CN 112666562B CN 202011467799 A CN202011467799 A CN 202011467799A CN 112666562 B CN112666562 B CN 112666562B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- inertial navigation
- matrix
- array
- imaging
- 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
Images
Landscapes
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明属于合成孔径声纳信号处理领域,涉及一种合成孔径声纳运动补偿与成像方法,建立基阵坐标系、惯导安装坐标系、惯导坐标系、地球坐标系、地理坐标系、导航坐标系和成像坐标系等多个坐标系,结合各参数,构建不同坐标系之间的平移矩阵和旋转矩阵;精确推算得到信号发射时刻发射阵在成像坐标系中的坐标,以及接收阵各阵元信号接收时刻在成像坐标系中的坐标,合成孔径声纳运动补偿与成像;最终获得合成孔径声纳二维声图。本发明避免声纳基阵和惯性导航系统的安装误差、杠杆臂效应以及非停走停模式引入的运动误差,提高合成孔径声纳成像质量。合成孔径声纳逐点成像算法可以同时完成运动补偿和成像,运动补偿效果好,成像精度高。
Description
技术领域
本发明属于合成孔径声纳信号处理领域,尤其涉及一种合成孔径声纳运动补偿与成像方法。
背景技术
目前,合成孔径声纳是一种新型高分辨水下成像声纳,可以获得海底(水底)全距离恒定的二维高分辨图像,广泛应用于水下地形地貌测绘、海底底质勘探、考古搜救、沉物打捞、海底电缆及石油管道敷设、水下目标识别与分类、沉底雷和掩埋雷探测以及军民用港口和重要海域的水下高分辨侦查等活动。运动补偿是合成孔径声纳成像过程中极为关键的步骤,其本质是从运动传感器或回波数据中估计声纳运动误差,通过补偿该误差进一步提高二维声图质量。合成孔径声纳一般搭载于无动力拖体或自主式水下航行器,通常要求载体作匀速直线运动。在实际工作中,受海风、海浪、海流的影响,声纳载体的运动轨迹总是与理想的匀速直线运动航迹存在偏差。研究表明,当声纳载体的运动偏离理想航迹超过工作波长的1/8时,必须进行运动补偿,否则会严重影响成像质量。早期的合成孔径声纳运动补偿与成像大多建立在合成孔径雷达相关研究成果的基础上,多接收阵元技术和非停走停模式的引入导致合成孔径声纳在系统结构和工作模式等方面远复杂于合成孔径雷达,这使得合成孔径雷达在运动补偿与成像方面的研究和发展可以被合成孔径声纳借鉴,但难以被直接利用。非停走停模式下信号收发期间声纳平台的运动时间通常被称为非停走停时间。
常用的运动补偿方法主要有两种,一种是基于运动传感器的运动补偿方法,另一种是基于回波数据的运动补偿方法。这里的运动传感器主要是指惯性导航系统,安装于声纳载体,实时记录声纳载体的位置和姿态。基于运动传感器的运动补偿方法与传感器的测量精度直接相关,其关键在于如何利用运动传感器的输出数据准确地推算声纳发射阵和接收阵不同阵元在成像坐标系中的实际坐标。精确的坐标推算过程需要综合考虑多种因素,涉及坐标系转换较多,考虑不充分将产生推算误差。非停走停模式的引入,要求获得接收阵不同阵元在各自接收信号时刻的坐标,传统坐标推算方法无法实现该目标。
通过上述分析,现有技术存在的问题及缺陷为:
(1)没有理清推算运动补偿与成像需要的坐标数据的过程中可能涉及的坐标系,以及坐标系之间的平移矩阵和旋转矩阵,坐标推算过程不够清晰直观;
(2)未能充分考虑声基阵和惯性导航系统的安装误差以及杠杆臂效应等多种因素,可能导致坐标推算存在误差;
(3)未能充分考虑非停走停模式下非停走停时间对于接收阵元位置的影响,导致非停走停模式下接收阵不同阵元信号接收时刻的坐标不准确;
上述问题将会导致合成孔径声纳运动补偿与成像所需的坐标数据推算精度不高,进而导致运动补偿效果不佳,降低合成孔径声纳成像质量。
发明内容
针对现有技术存在的问题,本发明提供了一种合成孔径声纳运动补偿与成像方法,可以得到发射阵在信号发射时刻位于成像坐标系的坐标以及接收阵各阵元在各自的信号接收时刻位于成像坐标系中的坐标,结合高精度的合成孔径声纳逐点成像算法,可以有效改善合成孔径声纳运动补偿效果,提高合成孔径声纳图像质量。
本发明是这样实现的,一种合成孔径声纳运动补偿与成像方法,包括:
建立基阵坐标系、惯导安装坐标系、惯导坐标系、地球坐标系、地理坐标系、导航坐标系和成像坐标系,根据高精度惯性导航系统的输出数据,结合发射阵、接收阵、惯性导航系统的设计参数和安装参数,构建不同坐标系之间的平移矩阵和旋转矩阵,精确推算得到信号发射时刻发射阵在成像坐标系中的坐标,以及接收阵各阵元信号接收时刻在成像坐标系中的坐标,利用合成孔径声纳逐点成像算法,同时完成合成孔径声纳运动补偿与成像操作,最终获得高质量的合成孔径声纳二维声图。
进一步,建立多个坐标系。
所述多个坐标系包括基阵坐标系、惯导安装坐标系、惯导坐标系、地球坐标系、地理坐标系、导航坐标系和成像坐标系,但不限于上述坐标系。
进一步,根据高精度惯性导航系统的输出数据,结合发射阵、接收阵、惯性导航系统的设计参数和安装参数,构建不同坐标系之间的平移矩阵和旋转矩阵。
所述高精度惯导系统的输出数据包括经度、纬度、高度和姿态角。
进一步,发射阵、接收阵、惯性导航系统的设计参数主要包括发射阵的阵长、接收阵各阵元阵长及排布方式以及惯性导航系统的尺寸及质心位置。
进一步,发射阵、接收阵、惯性导航系统的安装参数包括发射阵、接收阵各阵元、惯性导航系统质心在惯导安装坐标系中的坐标,以及惯导坐标系相对于惯导安装坐标系的姿态角和基阵坐标系相对于惯导安装坐标系的姿态角。
发射阵、接收阵、惯性导航系统的安装参数利用光学测量方法得到。
进一步,根据发射阵和接收阵各阵元在成像坐标系中的坐标,利用合成孔径声纳逐点成像算法,同时完成合成孔径声纳运动补偿和成像。
发射阵在成像坐标系中的坐标是指信号发射时刻发射阵在成像坐标系中的坐标。
接收阵各阵元在成像坐标系中的坐标是指接收阵各阵元在各自的信号接收时刻位于成像坐标系中的坐标。
进一步,利用合成孔径声纳逐点成像算法,完成合成孔径声纳运动补偿和成像,获得高质量的合成孔径声纳二维声图。所述逐点成像算法包括其改进算法。
结合上述的所有技术方案,本发明所具备的优点及积极效果为:
本发明理清了运动补偿与成像需要的坐标数据推算过程中可能涉及的坐标系,推导了不同坐标系之间的平移矩阵和旋转矩阵,坐标推算过程更加清晰、直观。
充分考虑声基阵、惯性导航系统的安装误差和杠杆臂效应等多种因素,并将该多种因素利用坐标系之间的平移矩阵和旋转矩阵明确表示,使得坐标推算更加准确,易于理解。
提出非停走停模式下需要推算的是发射阵在信号发射时刻位于成像坐标系中的坐标以及接收阵各阵元在各自的信号接收时刻位于成像坐标系中的坐标这一思想,并且给出了推算方法和结果,可以有效避免非停走停模式可能引入的运动误差,提高合成孔径声纳成像质量。
合成孔径声纳逐点成像算法可以同时完成运动补偿和成像,运动补偿效果好,成像精度高。
附图说明
为了更清楚地说明本申请实施例的技术方案,下面将对本申请实施例中所需要使用的附图做简单的介绍,显而易见地,下面所描述的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下还可以根据这些附图获得其他的附图。
图1是本发明实施例提供的基于高精度惯性导航系统的合成孔径声纳运动补偿与成像方法流程图。
图2是本发明实施例提供的合成孔径声纳成像距离历程几何模型示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
针对现有技术存在的问题,本发明提供了一种基于高精度惯性导航系统的合成孔径声纳运动补偿与成像方法,下面结合附图对本发明作详细的描述。
本发明提供一种合成孔径声纳运动补偿与成像方法:
建立基阵坐标系,根据声基阵的设计参数和安装参数,确定发射阵、接收阵各阵元在基阵坐标系中的坐标;
根据惯性导航系统安装基准面,建立惯导安装坐标系,根据惯性导航系统的设计参数和安装参数,建立惯导坐标系,结合惯性导航系统的设计参数,利用光学测量方法获得惯性导航系统质心在惯导安装坐标系中的坐标,以及惯导坐标系相对于惯导安装坐标系的姿态角,构建惯导坐标系与惯导安装坐标系之间的平移矩阵和旋转矩阵;
根据声基阵的设计参数和安装参数,利用光学测量方法,获得基阵坐标系原点在惯导安装坐标系中的坐标,以及基阵坐标系相对于惯导安装坐标系的姿态角,构建基阵坐标系与惯导安装坐标系之间的平移矩阵和旋转矩阵;
根据基阵坐标系到惯导安装坐标系的旋转矩阵以及惯导安装坐标系到惯导坐标系的旋转矩阵,构建基阵坐标系与惯导坐标系之间的旋转矩阵;
根据基阵坐标系原点在惯导安装坐标系中的坐标,以及惯导安装坐标系与惯导坐标系之间的旋转矩阵和平移矩阵,推算基阵坐标系原点在惯导坐标系中的坐标,构建基阵坐标系与惯导坐标系之间的平移矩阵;
根据发射阵、接收阵各阵元在基阵坐标系中的坐标,以及基阵坐标系与惯导坐标系之间的平移矩阵和旋转矩阵,推算发射阵、接收阵各阵元在惯导坐标系中的坐标;
根据惯导数据输出时刻惯性导航系统输出的经度、纬度和高度,建立地理坐标系,构建惯导数据输出时刻地球坐标系与地理坐标系之间的平移矩阵和旋转矩阵;
根据惯导坐标系和地理坐标系的定义,以及惯导数据输出时刻惯性导航系统输出的姿态角,构建惯导数据输出时刻惯导坐标系与地理坐标系之间的平移矩阵和旋转矩阵;
根据不同惯导数据输出时刻惯性导航系统输出的经度、纬度和高度,推算惯导数据输出时刻惯性导航系统质心在地球坐标系中的直角坐标,构建惯导数据输出时刻惯导坐标系与地球坐标系之间的平移矩阵;
根据惯导数据输出时刻惯导坐标系与地理坐标系之间的旋转矩阵以及地理坐标系与地球坐标系之间的旋转矩阵,构建惯导数据输出时刻地球坐标系与惯导坐标系之间的旋转矩阵;
根据基阵坐标系原点在惯导坐标系中的坐标,以及惯导数据输出时刻惯导坐标系与地球坐标系之间的平移矩阵和旋转矩阵,推算不同惯导数据输出时刻基阵坐标系原点在地球坐标系中的直角坐标和球坐标;
以惯性导航系统第一包数据输出时刻基阵坐标系原点为原点,根据同一时刻基阵坐标系原点的经度、纬度,建立导航坐标系;
根据惯导数据输出时刻基阵坐标系原点在地球坐标系中的经度、纬度和高度,推算惯导数据输出时刻基阵坐标系原点在导航坐标系中的坐标;
根据惯导数据输出时刻基阵坐标系原点在导航坐标系中的坐标,利用最小二乘法进行线性拟合,得到理想航迹,确定理想航迹在导航坐标系中的斜率和截距;
以第一个等于惯导数据输出时刻或者介于前后相邻两个惯导数据输出时刻之间的脉冲发射时刻导航坐标系中基阵坐标系原点在理想航迹中的投影点为原点,以理想航迹为X轴,建立成像坐标系,确定成像坐标系原点在导航坐标系中的坐标,构建成像坐标系与导航坐标系之间的平移矩阵;
根据成像坐标系和导航坐标系的定义,以及理想航迹在导航坐标系中的斜率,推算成像坐标系与导航坐标系之间的姿态角,构建成像坐标系与导航坐标系之间的旋转矩阵;
根据惯导数据输出时刻惯性导航系统输出的姿态角,确定信号发射时刻惯导坐标系与导航坐标系之间的旋转矩阵;
根据基阵坐标系与惯导坐标系之间的旋转矩阵、信号发射时刻惯导坐标系与导航坐标系的旋转矩阵以及导航坐标系与成像坐标系之间的旋转矩阵,构建信号发射时刻基阵坐标系与成像坐标系之间的旋转矩阵;
根据惯导数据输出时刻基阵坐标系原点在导航坐标系中的坐标,利用线性插值方法得到信号发射时刻基阵坐标系原点在导航坐标系中的坐标,结合导航坐标系与成像坐标系之间的平移矩阵和旋转矩阵,推算信号发射时刻基阵坐标系原点在成像坐标系中的坐标,构建信号发射时刻基阵坐标系与成像坐标系之间的平移矩阵;
根据发射阵、接收阵各阵元在基阵坐标系中的坐标,以及信号发射时刻基阵坐标系与成像坐标系之间的平移矩阵和旋转矩阵,推算信号发射时刻发射阵、接收阵各阵元在成像坐标系中的坐标;
建立合成孔径声纳成像距离历程几何模型,根据非停走停时间的定义,结合发射阵、接收阵的设计参数和安装参数,以及信号发射时刻发射阵、接收阵各阵元在成像坐标系中的坐标,计算接收阵各阵元的非停走停时间,确定接收阵各阵元信号接收时刻;
根据惯导数据输出时刻基阵坐标系原点在导航坐标系的坐标,利用线性插值方法得到接收阵各阵元信号接收时刻基阵坐标系原点在导航坐标系中的坐标,结合导航坐标系与成像坐标系的平移矩阵和旋转矩阵,推算接收阵各阵元信号接收时刻基阵坐标系原点在成像坐标系中的坐标,构建接收阵各阵元信号接收时刻基阵坐标系与成像坐标系的平移矩阵;
根据惯导数据输出时刻惯性导航系统输出的姿态角,利用线性插值方法得到接收阵各阵元信号接收时刻惯性导航系统的姿态角,推算接收阵各阵元信号接收时刻惯导坐标系与导航坐标系的旋转矩阵,结合基阵坐标系与惯导坐标系的旋转矩阵、导航坐标系与成像坐标系的旋转矩阵,构建接收阵各阵元信号接收时刻基阵坐标系与成像坐标系的旋转矩阵;
根据接收阵各阵元在基阵坐标系中的坐标,以及接收阵各阵元信号接收时刻基阵坐标系与成像坐标系之间的平移矩阵和旋转矩阵,确定接收阵各阵元接收信号时刻在成像坐标系中的坐标;
根据信号发射时刻发射阵在成像坐标系中的坐标以及接收阵各阵元信号接收时刻接收阵各阵元在成像坐标系中的坐标,利用合成孔径声纳逐点成像算法同时完成运动补偿与成像操作,获得合成孔径声纳二维图像。
下面结合具体实施例对本发明的技术方案作进一步描述。
图1为基于高精度惯性导航系统的合成孔径声纳运动补偿与成像方法流程图。
建立基阵坐标系,根据声基阵的设计参数和安装参数,确定发射阵、接收阵各阵元在基阵坐标系中的坐标,分别用和表示,其中上标Tr和Rr分别表示发射阵和接收阵,下标S表示基阵坐标系,下标i表示接收阵阵元序号,i=1,2,…,M,M表示合成孔径声纳接收阵包含的接收阵元数量。
根据惯性导航系统安装基准面,建立惯导安装坐标系,用P0表示;根据惯性导航系统的设计参数和安装参数,建立惯导坐标系,用P表示;结合惯性导航系统的设计参数,利用光学测量方法获得惯性导航系统质心OP在惯导安装坐标系中的坐标以及从惯导安装坐标系旋转到惯导坐标系的姿态角,分别用偏航角俯仰角横滚角表示;构建惯导坐标系与惯导安装坐标系之间的平移矩阵和旋转矩阵其中 其中
根据声基阵的设计参数和安装参数,利用光学测量方法,获得基阵坐标系原点在惯导安装坐标系中的坐标以及从惯导安装坐标系旋转至基阵坐标系的姿态角,分别用偏航角俯仰角横滚角表示,构建基阵坐标系与惯导安装坐标系之间的平移矩阵和旋转矩阵其中 其中
根据惯导安装坐标系到基阵坐标系的旋转矩阵以及惯导坐标系到惯导安装坐标系的旋转矩阵构建基阵坐标系与惯导坐标系之间的旋转矩阵其中根据基阵坐标系原点在惯导安装坐标系中的坐标以及惯导安装坐标系与惯导坐标系之间的旋转矩阵和平移矩阵推算基阵坐标系原点在惯导坐标系中的坐标构建基阵坐标系与惯导坐标系之间的平移矩阵
根据发射阵、接收阵各阵元在基阵坐标系中的坐标以及从基阵坐标系到惯导坐标系的平移矩阵和旋转矩阵推算发射阵、接收阵各阵元在惯导坐标系中的坐标分别为根据惯导数据输出时刻惯性导航系统输出的经度、纬度和高度,分别用λP,j、和hP,j表示,j=1,…,NP,表示惯性导航系统输出的数据包数量,推算惯性导航系统质心在地球坐标系中的直角坐标下标E表示地球坐标系,
根据惯导数据输出时刻惯导坐标系与地理坐标系之间的旋转矩阵以及地理坐标系与地球坐标系之间的旋转矩阵构建惯导数据输出时刻地球坐标系与惯导坐标系之间的旋转矩阵其中根据基阵坐标系原点OS在惯导坐标系中的坐标以及惯导数据输出时刻惯导坐标系与地球坐标系之间的平移矩阵和旋转矩阵推算惯导数据输出时刻基阵坐标系原点在地球坐标系中的直角坐标和球坐标其中
以惯性导航系统第1包数据输出时刻基阵坐标系原点为原点,用ON表示,根据同一时刻基阵坐标系原点的经度、纬度,建立导航坐标系,用N表示;根据惯导数据输出时刻基阵坐标系原点在地球坐标系中的经度、纬度和高度,推算惯导数据输出时刻基阵坐标系原点在导航坐标系中的坐标
其中Rm0和Rm1均为地球主曲率半径, λOs,1、hOs,1分别为惯性导航系统第1包数据输出时刻基阵坐标系原点在地球坐标系中的经度、纬度和高度;根据惯导数据输出时刻基阵坐标系原点在导航坐标系中的坐标利用最小二乘法进行线性拟合,得到理想航迹,用y=kIx+bI表示,确定理想航迹在导航坐标系中的斜率kI和截距bI;
以第一个等于惯导数据输出时刻或者介于前后相邻两个惯导数据输出时刻之间的脉冲发射时刻基阵坐标系原点在理想航迹中的投影点为原点,以理想航迹为X轴,建立成像坐标系,用F表示,确定成像坐标系原点OF在导航坐标系中的坐标构建成像坐标系与导航坐标系之间的平移矩阵
根据成像坐标系和导航坐标系的定义,以及理想航迹在导航坐标系中的斜率kI,推算成像坐标系与导航坐标系之间的姿态角构建成像坐标系与导航坐标系之间的旋转矩阵根据惯导数据输出时刻惯性导航系统输出的姿态角,利用线性插值方法确定信号发射时刻惯性导航系统的姿态角,构建信号发射时刻惯导坐标系与导航坐标系之间的旋转矩阵k=1,…,NPulse,NPulse表示脉冲个数;
根据基阵坐标系与惯导坐标系之间的旋转矩阵信号发射时刻惯导坐标系与导航坐标系的旋转矩阵以及导航坐标系与成像坐标系之间的旋转矩阵构建信号发射时刻基阵坐标系与成像坐标系之间的旋转矩阵根据惯导数据输出时刻基阵坐标系原点在导航坐标系中的坐标利用线性插值方法得到信号发射时刻基阵坐标系原点在导航坐标系中的坐标结合导航坐标系与成像坐标系之间的平移矩阵和旋转矩阵推算信号发射时刻基阵坐标系原点在成像坐标系中的坐标构建信号发射时刻基阵坐标系与成像坐标系之间的平移矩阵根据发射阵、接收阵各阵元在基阵坐标系中的坐标以及信号发射时刻基阵坐标系与成像坐标系之间的平移矩阵和旋转矩阵推算信号发射时刻发射阵、接收阵各阵元在成像坐标系中的坐标
c为水下声速,为第k个信号发射时刻发射阵在成像坐标系中的坐标,为第k个信号发射时刻第i个接收阵元在成像坐标系中的坐标,为目标P0在成像坐标系中的坐标,为第k个信号发射时刻与第k+1个信号发射时刻之间第i个接收阵元沿理想航迹的平均航速,PRI为脉冲重复周期,RTr为信号发射时刻发射阵与目标P0之间的斜距;
根据惯导数据输出时刻基阵坐标系原点在导航坐标系的坐标利用线性插值方法得到接收阵各阵元信号接收时刻基阵坐标系原点OS_RT在导航坐标系中的坐标结合导航坐标系与成像坐标系的平移矩阵和旋转矩阵推算接收阵各阵元信号接收时刻基阵坐标系原点在成像坐标系中的坐标构建接收阵各阵元信号接收时刻基阵坐标系与成像坐标系的平移矩阵下标S_RT表示信号接收时刻的基阵坐标系;
根据惯导数据输出时刻惯性导航系统输出的姿态角利用线性插值方法得到接收阵各阵元信号接收时刻惯性导航系统的姿态角推算接收阵各阵元信号接收时刻惯导坐标系与导航坐标系的旋转矩阵结合基阵坐标系与惯导坐标系的旋转矩阵导航坐标系与成像坐标系的旋转矩阵构建接收阵各阵元信号接收时刻基阵坐标系与成像坐标系的旋转矩阵根据接收阵各阵元在基阵坐标系中的坐标以及接收阵各阵元信号接收时刻基阵坐标系与成像坐标系之间的平移矩阵和旋转矩阵确定接收阵各阵元接收信号时刻在成像坐标系中的坐标
在本发明的描述中,除非另有说明,“多个”的含义是两个或两个以上;术语“上”、“下”、“左”、“右”、“内”、“外”、“前端”、“后端”、“头部”、“尾部”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一”、“第二”、“第三”等仅用于描述目的,而不能理解为指示或暗示相对重要性。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,都应涵盖在本发明的保护范围之内。
Claims (6)
1.一种合成孔径声纳运动补偿与成像方法,其特征在于,所述合成孔径声纳运动补偿与成像方法包括:
建立多个坐标系,根据高精度惯性导航系统的输出数据,结合发射阵、接收阵、惯性导航系统的设计参数和安装参数,构建不同坐标系之间的平移矩阵和旋转矩阵;
精确推算得到信号发射时刻发射阵在成像坐标系中的坐标,以及接收阵各阵元信号接收时刻在成像坐标系中的坐标;根据发射阵、接收阵各阵元在基阵坐标系中的坐标以及信号发射时刻基阵坐标系与成像坐标系之间的平移矩阵和旋转矩阵推算信号发射时刻发射阵、接收阵各阵元在成像坐标系中的坐标所述根据接收阵各阵元在基阵坐标系中的坐标以及接收阵各阵元信号接收时刻基阵坐标系与成像坐标系之间的平移矩阵和旋转矩阵确定接收阵各阵元接收信号时刻在成像坐标系中的坐标
利用合成孔径声纳逐点成像算法,同时完成合成孔径声纳运动补偿与成像操作,获得高质量的合成孔径声纳二维声图;
所述根据惯导数据输出时刻惯导坐标系与地理坐标系之间的旋转矩阵以及地理坐标系与地球坐标系之间的旋转矩阵构建惯导数据输出时刻地球坐标系与惯导坐标系之间的旋转矩阵其中根据基阵坐标系原点OS在惯导坐标系中的坐标以及惯导数据输出时刻惯导坐标系与地球坐标系之间的平移矩阵和旋转矩阵推算惯导数据输出时刻基阵坐标系原点在地球坐标系中的直角坐标和球坐标其中
以惯性导航系统第1包数据输出时刻基阵坐标系原点为原点,用ON表示,根据同一时刻基阵坐标系原点的经度、纬度,建立导航坐标系,用N表示;根据惯导数据输出时刻基阵坐标系原点在地球坐标系中的经度、纬度和高度,推算惯导数据输出时刻基阵坐标系原点在导航坐标系中的坐标
其中Rm0和Rm1均为地球主曲率半径, Rc=(Ra-Rb)/Ra,分别为惯性导航系统第1包数据输出时刻基阵坐标系原点在地球坐标系中的经度、纬度和高度;根据惯导数据输出时刻基阵坐标系原点在导航坐标系中的坐标利用最小二乘法进行线性拟合,得到理想航迹,用y=kIx+bI表示,确定理想航迹在导航坐标系中的斜率kI和截距bI;
以第一个等于惯导数据输出时刻或者介于前后相邻两个惯导数据输出时刻之间的脉冲发射时刻基阵坐标系原点在理想航迹中的投影点为原点,以理想航迹为X轴,建立成像坐标系,用F表示,确定成像坐标系原点OF在导航坐标系中的坐标构建成像坐标系与导航坐标系之间的平移矩阵
所述根据惯导数据输出时刻基阵坐标系原点在导航坐标系中的坐标利用线性插值方法得到信号发射时刻基阵坐标系原点在导航坐标系中的坐标结合导航坐标系与成像坐标系之间的平移矩阵和旋转矩阵推算信号发射时刻基阵坐标系原点在成像坐标系中的坐标构建信号发射时刻基阵坐标系与成像坐标系之间的平移矩阵
所述根据非停走停时间的定义,结合发射阵、接收阵的设计参数和安装参数,以及信号发射时刻发射阵、接收阵各阵元在成像坐标系中的坐标,计算接收阵各阵元的非停走停时间其中AA=c2-v2, c为水下声速,为第k个信号发射时刻发射阵在成像坐标系中的坐标,为第k个信号发射时刻第i个接收阵元在成像坐标系中的坐标,为目标P0在成像坐标系中的坐标,为第k个信号发射时刻与第k+1个信号发射时刻之间第i个接收阵元沿理想航迹的平均航速,PRI为脉冲重复周期,RTr为信号发射时刻发射阵与目标P0之间的斜距;
根据惯导数据输出时刻基阵坐标系原点在导航坐标系的坐标利用线性插值方法得到接收阵各阵元信号接收时刻基阵坐标系原点OS_RT在导航坐标系中的坐标结合导航坐标系与成像坐标系的平移矩阵和旋转矩阵推算接收阵各阵元信号接收时刻基阵坐标系原点在成像坐标系中的坐标构建接收阵各阵元信号接收时刻基阵坐标系与成像坐标系的平移矩阵下标S_RT表示信号接收时刻的基阵坐标系;
根据惯导数据输出时刻惯性导航系统输出的姿态角利用线性插值方法得到接收阵各阵元信号接收时刻惯性导航系统的姿态角推算接收阵各阵元信号接收时刻惯导坐标系与导航坐标系的旋转矩阵结合基阵坐标系与惯导坐标系的旋转矩阵导航坐标系与成像坐标系的旋转矩阵构建接收阵各阵元信号接收时刻基阵坐标系与成像坐标系的旋转矩阵
2.如权利要求1所述的合成孔径声纳运动补偿与成像方法,其特征在于,所述多个坐标系包括基阵坐标系、惯导安装坐标系、惯导坐标系、地球坐标系、地理坐标系、导航坐标系和成像坐标系。
3.如权利要求1所述的合成孔径声纳运动补偿与成像方法,其特征在于,所述高精度惯性导航系统的输出数据包括惯性导航系统数据输出时刻惯导质心的经度、纬度、高度和姿态角;
所述发射阵、接收阵、惯性导航系统的设计参数包括发射阵的阵长、接收阵各阵元阵长及排布方式以及惯性导航系统的尺寸及质心位置;
所述发射阵、接收阵、惯性导航系统的安装参数包括发射阵、接收阵各阵元、惯性导航系统质心在惯导安装坐标系中的坐标,以及惯导坐标系相对于惯导安装坐标系的姿态角和基阵坐标系相对于惯导安装坐标系的姿态角;
所述发射阵、接收阵、惯性导航系统的安装参数利用光学测量方法得到。
4.如权利要求1所述的合成孔径声纳运动补偿与成像方法,其特征在于,所述合成孔径声纳运动补偿与成像方法具体包括:
建立基阵坐标系,根据声基阵的设计参数和安装参数,确定发射阵、接收阵各阵元在基阵坐标系中的坐标;
根据惯性导航系统安装基准面,建立惯导安装坐标系,根据惯性导航系统的设计参数和安装参数,建立惯导坐标系,结合惯性导航系统的设计参数,利用光学测量方法获得惯性导航系统质心在惯导安装坐标系中的坐标,以及惯导坐标系相对于惯导安装坐标系的姿态角,构建惯导坐标系与惯导安装坐标系之间的平移矩阵和旋转矩阵;
根据声基阵的设计参数和安装参数,利用光学测量方法,获得基阵坐标系原点在惯导安装坐标系中的坐标,以及基阵坐标系相对于惯导安装坐标系的姿态角,构建基阵坐标系与惯导安装坐标系之间的平移矩阵和旋转矩阵;
根据基阵坐标系到惯导安装坐标系的旋转矩阵以及惯导安装坐标系到惯导坐标系的旋转矩阵,构建基阵坐标系与惯导坐标系之间的旋转矩阵;
根据基阵坐标系原点在惯导安装坐标系中的坐标,以及惯导安装坐标系与惯导坐标系之间的旋转矩阵和平移矩阵,推算基阵坐标系原点在惯导坐标系中的坐标,构建基阵坐标系与惯导坐标系之间的平移矩阵;
根据发射阵、接收阵各阵元在基阵坐标系中的坐标,以及基阵坐标系与惯导坐标系之间的平移矩阵和旋转矩阵,推算发射阵、接收阵各阵元在惯导坐标系中的坐标;
根据惯导数据输出时刻惯性导航系统输出的经度、纬度和高度,建立地理坐标系,构建惯导数据输出时刻地球坐标系与地理坐标系之间的平移矩阵和旋转矩阵;
根据惯导坐标系和地理坐标系的定义,以及惯导数据输出时刻惯性导航系统输出的姿态角,构建惯导数据输出时刻惯导坐标系与地理坐标系之间的平移矩阵和旋转矩阵;
根据不同惯导数据输出时刻惯性导航系统输出的经度、纬度和高度,推算惯导数据输出时刻惯性导航系统质心在地球坐标系中的直角坐标,构建惯导数据输出时刻惯导坐标系与地球坐标系之间的平移矩阵;
根据惯导数据输出时刻惯导坐标系与地理坐标系之间的旋转矩阵以及地理坐标系与地球坐标系之间的旋转矩阵,构建惯导数据输出时刻地球坐标系与惯导坐标系之间的旋转矩阵;
根据基阵坐标系原点在惯导坐标系中的坐标,以及惯导数据输出时刻惯导坐标系与地球坐标系之间的平移矩阵和旋转矩阵,推算不同惯导数据输出时刻基阵坐标系原点在地球坐标系中的直角坐标和球坐标;
以惯性导航系统第一包数据输出时刻基阵坐标系原点为原点,根据同一时刻基阵坐标系原点的经度、纬度,建立导航坐标系;
根据惯导数据输出时刻基阵坐标系原点在地球坐标系中的经度、纬度和高度,推算惯导数据输出时刻基阵坐标系原点在导航坐标系中的坐标;
根据惯导数据输出时刻基阵坐标系原点在导航坐标系中的坐标,利用最小二乘法进行线性拟合,得到理想航迹,确定理想航迹在导航坐标系中的斜率和截距;
以第一个等于惯导数据输出时刻或者介于前后相邻两个惯导数据输出时刻之间的脉冲发射时刻导航坐标系中基阵坐标系原点在理想航迹中的投影点为原点,以理想航迹为X轴,建立成像坐标系,确定成像坐标系原点在导航坐标系中的坐标,构建成像坐标系与导航坐标系之间的平移矩阵;
根据成像坐标系和导航坐标系的定义,以及理想航迹在导航坐标系中的斜率,推算成像坐标系与导航坐标系之间的姿态角,构建成像坐标系与导航坐标系之间的旋转矩阵;
根据惯导数据输出时刻惯性导航系统输出的姿态角,确定信号发射时刻惯导坐标系与导航坐标系之间的旋转矩阵;
根据基阵坐标系与惯导坐标系之间的旋转矩阵、信号发射时刻惯导坐标系与导航坐标系的旋转矩阵以及导航坐标系与成像坐标系之间的旋转矩阵,构建信号发射时刻基阵坐标系与成像坐标系之间的旋转矩阵;
根据惯导数据输出时刻基阵坐标系原点在导航坐标系中的坐标,利用线性插值方法得到信号发射时刻基阵坐标系原点在导航坐标系中的坐标,结合导航坐标系与成像坐标系之间的平移矩阵和旋转矩阵,推算信号发射时刻基阵坐标系原点在成像坐标系中的坐标,构建信号发射时刻基阵坐标系与成像坐标系之间的平移矩阵;
根据发射阵、接收阵各阵元在基阵坐标系中的坐标,以及信号发射时刻基阵坐标系与成像坐标系之间的平移矩阵和旋转矩阵,推算信号发射时刻发射阵、接收阵各阵元在成像坐标系中的坐标;
建立合成孔径声纳成像距离历程几何模型,根据非停走停时间的定义,结合发射阵、接收阵的设计参数和安装参数,以及信号发射时刻发射阵、接收阵各阵元在成像坐标系中的坐标,计算接收阵各阵元的非停走停时间,确定接收阵各阵元信号接收时刻;
根据惯导数据输出时刻基阵坐标系原点在导航坐标系的坐标,利用线性插值方法得到接收阵各阵元信号接收时刻基阵坐标系原点在导航坐标系中的坐标,结合导航坐标系与成像坐标系的平移矩阵和旋转矩阵,推算接收阵各阵元信号接收时刻基阵坐标系原点在成像坐标系中的坐标,构建接收阵各阵元信号接收时刻基阵坐标系与成像坐标系的平移矩阵;
根据惯导数据输出时刻惯性导航系统输出的姿态角,利用线性插值方法得到接收阵各阵元信号接收时刻惯性导航系统的姿态角,推算接收阵各阵元信号接收时刻惯导坐标系与导航坐标系的旋转矩阵,结合基阵坐标系与惯导坐标系的旋转矩阵、导航坐标系与成像坐标系的旋转矩阵,构建接收阵各阵元信号接收时刻基阵坐标系与成像坐标系的旋转矩阵;
根据接收阵各阵元在基阵坐标系中的坐标,以及接收阵各阵元信号接收时刻基阵坐标系与成像坐标系之间的平移矩阵和旋转矩阵,确定接收阵各阵元接收信号时刻在成像坐标系中的坐标;
根据信号发射时刻发射阵在成像坐标系中的坐标以及接收阵各阵元信号接收时刻接收阵各阵元在成像坐标系中的坐标,利用合成孔径声纳逐点成像算法同时完成运动补偿与成像操作,获得合成孔径声纳二维图像。
5.如权利要求4所述的合成孔径声纳运动补偿与成像方法,其特征在于,所述建立基阵坐标系,根据声基阵的设计参数和安装参数,确定发射阵、接收阵各阵元在基阵坐标系中的坐标,分别用和表示,其中上标Tr和Rr分别表示发射阵和接收阵,下标S表示基阵坐标系,下标i表示接收阵阵元序号,i=1,2,…,M,M表示合成孔径声纳接收阵包含的接收阵元数量;
所述根据惯性导航系统安装基准面,建立惯导安装坐标系,用P0表示;根据惯性导航系统的设计参数和安装参数,建立惯导坐标系,用P表示;结合惯性导航系统的设计参数,利用光学测量方法获得惯性导航系统质心OP在惯导安装坐标系中的坐标以及从惯导安装坐标系旋转到惯导坐标系的姿态角,分别用偏航角俯仰角横滚角表示;构建惯导坐标系与惯导安装坐标系之间的平移矩阵和旋转矩阵其中 其中
6.如权利要求4所述的合成孔径声纳运动补偿与成像方法,其特征在于,所述根据声基阵的设计参数和安装参数,利用光学测量方法,获得基阵坐标系原点在惯导安装坐标系中的坐标以及从惯导安装坐标系旋转至基阵坐标系的姿态角,分别用偏航角俯仰角横滚角表示,构建基阵坐标系与惯导安装坐标系之间的平移矩阵和旋转矩阵其中 其中
所述根据惯导数据输出时刻惯性导航系统输出的经度、纬度和高度,分别用λP,j、和hP,j表示,j=1,…,NP,表示惯性导航系统输出的数据包数量,推算惯性导航系统质心在地球坐标系中的直角坐标下标E表示地球坐标系,
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011467799.7A CN112666562B (zh) | 2020-12-14 | 2020-12-14 | 一种合成孔径声纳运动补偿与成像方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011467799.7A CN112666562B (zh) | 2020-12-14 | 2020-12-14 | 一种合成孔径声纳运动补偿与成像方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112666562A CN112666562A (zh) | 2021-04-16 |
CN112666562B true CN112666562B (zh) | 2023-03-10 |
Family
ID=75405740
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011467799.7A Active CN112666562B (zh) | 2020-12-14 | 2020-12-14 | 一种合成孔径声纳运动补偿与成像方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112666562B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114449761A (zh) * | 2021-12-02 | 2022-05-06 | 深圳崇达多层线路板有限公司 | 一种改善深v盲孔加工的方法、印制电路板及应用 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101369021A (zh) * | 2008-10-09 | 2009-02-18 | 中国人民解放军海军工程大学 | 水下运动目标的二维散射特性测量方法 |
CN101782649A (zh) * | 2009-12-08 | 2010-07-21 | 中国科学院声学研究所 | 一种合成孔径声纳基阵速度估计系统与方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5626621B2 (ja) * | 2010-03-19 | 2014-11-19 | 株式会社 日立産業制御ソリューションズ | フェイズドアレイ合成開口ソナーシステム |
-
2020
- 2020-12-14 CN CN202011467799.7A patent/CN112666562B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101369021A (zh) * | 2008-10-09 | 2009-02-18 | 中国人民解放军海军工程大学 | 水下运动目标的二维散射特性测量方法 |
CN101782649A (zh) * | 2009-12-08 | 2010-07-21 | 中国科学院声学研究所 | 一种合成孔径声纳基阵速度估计系统与方法 |
Non-Patent Citations (5)
Title |
---|
A Fast Speckle Reduction Algorithm based on GPU for Synthetic Aperture Sonar;Xu Kui 等;《Advanced Science and Technology Letters》;20161231;第137卷;第8-17页 * |
基于合成孔径原理目标散射测量中的运动误差补偿;刘丹丹等;《海军工程大学学报》;20091015(第05期);第27-31页 * |
基于惯性测量系统的合成孔径声呐运动补偿;殷海庭等;《电子与信息学报》;20070120(第01期);第63-66页 * |
多接收阵合成孔径声呐CZT成像算法;马梦博 等;《华中科技大学学报(自然科学版)》;20190930;第47卷(第9期);第84-89页 * |
舰载ISAR成像平台运动补偿新方法研究;王勇 等;《制导与引信》;20200630;第41卷(第2期);第26-32页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112666562A (zh) | 2021-04-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110208812A (zh) | 半潜无人航行器海底三维地形探测装置及方法 | |
CN106643709B (zh) | 一种海上运载体的组合导航方法及装置 | |
CN102692217B (zh) | 运用地效应飞行器进行河道测量的方法 | |
Singh et al. | Microbathymetric mapping from underwater vehicles in the deep ocean | |
CN111350214B (zh) | 多波束水下钢管桩桩位测量方法 | |
CN110837086B (zh) | 一种基于侧扫声呐的海底目标定位方法和定位系统 | |
CN109737956A (zh) | 一种基于双应答器的sins/usbl相位差紧组合导航定位方法 | |
CN111829512A (zh) | 一种基于多传感器数据融合的auv导航定位方法及系统 | |
CN110319811A (zh) | 一种自适应波浪效应的水下单波束高精度探测系统及方法 | |
CA2256964C (en) | Method of locating hydrophones | |
Châtillon et al. | SAMI: A low-frequency prototype for mapping and imaging of the seabed by means of synthetic aperture | |
CN111220146A (zh) | 一种基于高斯过程回归学习的水下地形匹配定位方法 | |
CN109059746A (zh) | 一种基于精密pos的海底地形测量方法 | |
CN112666562B (zh) | 一种合成孔径声纳运动补偿与成像方法 | |
Jalving et al. | Terrain referenced navigation of AUVs and submarines using multibeam echo sounders | |
Dartnell et al. | Sea-floor Images and Data from Multibeam Surveys in San Francisco Bay, Southern California, Hawaii, the Gulf of Mexico, and Lake Tahoe, California--Nevada | |
CN112147578B (zh) | 一种高精度深水发射阵及多元垂直接收阵阵元定位系统与方法 | |
CN114234932A (zh) | 一种获取海底控制点数据的水下导线测量方法及装置 | |
CN111522013A (zh) | 一种基于侧扫声呐的海底目标定位装置 | |
CN116105685A (zh) | 基于声光遥感和滚轮的潮间带地形无缝一体化测量方法 | |
CN113218372B (zh) | 一种海底基准点位置标校系统及方法 | |
CN105115494B (zh) | 一种基于“准短基线”的惯性导航/水声组合导航方法 | |
CN112462322A (zh) | 一种水下蛙人定位方法及定位系统 | |
Foote et al. | Quantifying sidescan sonar positioning accuracy, with special reference to measurement in the intertidal zone | |
CN118429577B (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 |