CN102879779A - 一种基于sar遥感成像的杆臂测量及补偿方法 - Google Patents
一种基于sar遥感成像的杆臂测量及补偿方法 Download PDFInfo
- Publication number
- CN102879779A CN102879779A CN2012103247613A CN201210324761A CN102879779A CN 102879779 A CN102879779 A CN 102879779A CN 2012103247613 A CN2012103247613 A CN 2012103247613A CN 201210324761 A CN201210324761 A CN 201210324761A CN 102879779 A CN102879779 A CN 102879779A
- Authority
- CN
- China
- Prior art keywords
- imu
- sin
- delta
- cos
- theta
- 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.)
- Granted
Links
Images
Landscapes
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明涉及一种基于SAR遥感成像的杆臂测量及补偿方法,提出遥感载荷运动误差补偿时需精确测量的三级杆臂误差并根据各级杆臂误差的特点进行误差补偿。三级杆臂包括GPS天线至IMU敏感中心的相对位置即一级杆臂、IMU敏感中心至遥感载荷相位中心的相对位置即二级杆臂,利用IMU设计时的结构尺寸计算三只加速度计至IMU敏感中心的尺寸效应长度。本发明具有消除杆臂效应误差带来的位置、速度、姿态以及加速度计输出误差的特点,提高POS系统运动测量精度,并能获取遥感载荷相位中心精确运动信息以提高遥感载荷成像精度。
Description
技术领域
本发明涉及一种基于SAR遥感成像的杆臂测量及补偿方法,可用于精确测量尺寸效应、一级杆臂,二级杆臂及初始姿态阵。修正尺寸效应带来的有害加速度,修正一级杆臂带来的位置、速度误差,进而修正POS输出的运动信息,修正二级杆臂带来的位置、速度、加速度误差,并进行姿态转换以获得精确的SAR天线相位中心运动信息。
背景技术
航空遥感中,SAR成像需要载机做理想的匀速直线平移运动,然而由于载机受到大气湍流、飞控系统偏差等外力的影响,导致载机偏离理想运动轨迹,从而产生运动误差。位置姿态系统(Position & Orientation System,POS)用于为遥感载荷提供高精度的位置、速度、姿态信息以进行运动补偿。POS通常由惯性测量单元(Inertial Measurement Unit,IMU)、全球卫星定位系统(Global Position System,GPS)、POS数据采集与处理系统和后处理软件组成,POS系统本质上是一种基于SINS(Strapdown Inertial Navigation System)和GPS(Global Positioning System)的组合导航系统,利用GPS长期定位精度高及SINS短期定位定向精度高而实现的互补运动信息测量系统,因此,提高SINS运动信息测量精度对提高POS系统的精度具有重要意义。
杆臂效应是影响SINS短期运动测量精度的一个重要因素。当载机绕质心做角运动时,载机上非质心点处的加速度与质心点处加速度不一致,其包含了与杆臂长度成正比的向心加速度及切向加速度,这种因敏感中心与载机质心不重合且载机做角运动时非质心处加速度与质心处加速度不一致的现象称为杆臂效应。因加速度计敏感点与IMU敏感中心并不重合,导致存在尺寸效应误差,且尺寸效应误差与加速度计敏感轴方向有关,IMU初始安装误差的存在导致加速度计敏感轴方向发生变化,必须考虑耦合安装误差的尺寸效应误差。IMU敏感中心与GPS天线不在同一点,且其距离通常达到m级,因此在进行组合导航时必须考虑GPS天线至IMU敏感中心的杆臂效应误差。同理,IMU敏感中心与SAR相位中心不重合,存在二级杆臂误差。
现有的SAR运补杆臂补偿方案,通过补偿IMU与GPS之间的一级杆臂误差及二级杆臂误差得到SAR天线中心的运动信息,而未考虑IMU内部由安装误差导致的尺寸效应误差,也未给出杆臂测量及初始安装姿态矩阵的确定方法。此外,在补偿一级杆臂时,未考虑位置误差含有的杆臂分量,从而引起测量误差。现有方法存在以下不足:1、在载机做高动态机动时,由尺寸效应误差导致加速度计输出的有害加速度达到100μg量级与加速度计精度相当,尤其对于干涉SAR成像影响严重,必须予以补偿;2、加速度计的尺寸效应不仅与其长度有关,而且与各加速度计敏感轴方向有关,IMU相对于载机存在安装方位误差,导致加速度计敏感轴方向发生变化,从而使尺寸效应误差引入角加速度误差,易引入高频运动测量误差;3、IMU相对于载机的初始安装姿态及SAR天线相对于载机的初始安装姿态确定方法未见公开报道;4、对于一级杆臂,现有的方法仅进行了速度误差分量的补偿,而GPS接收机同时输出位置、速度信息,忽略位置观测量中包含的一级杆臂误差将使位置、速度及姿态测量误差增大;
发明内容
本发明的技术解决的问题是:给出一种基于SAR遥感成像的杆臂测量及补偿方法。对SAR遥感成像运动补偿涉及的杆臂效应误差分为三级,依据各系统之间传感器输出关系及杆臂误差的表现形式分为三级杆臂,在IMU内部,因加速度计敏感位置与IMU敏感中心不同而引入尺寸效应误差,且尺寸效应误差与IMU相对于载机的安装方位误差有关,提出了一种分离安装误差的尺寸效应计算方法。在IMU与GPS之间存在的一级杆臂将引入位置、速度误差,提出在导航系下对位置误差及速度误差进行修正以补偿一级杆臂误差,对于IMU与SAR之间存在的二级杆臂将使IMU敏感中心的位置、速度、加速度与SAR相位中心相关信息存在杆臂误差,且SAR本身定义的坐标系与POS不同,为此,需将IMU的姿态信息变换至SAR相位中心的姿态。本方法可推广至其他载荷的杆臂测量及补偿。
本发明的技术解决方案为:一种基于SAR遥感成像的杆臂测量及补偿方法。其特点在于包括下列步骤:
(1)建立飞机载体坐标系b系ObXbYbZb、当地地理坐标系g系OgXgYgZg、IMU坐标系f系OfXfYfZf、地心惯性坐标系i系OiXiYiZi。其中,ObXbYbZb系坐标原点为飞机质心Ob,Xb轴指向飞机右翼水平方向,Yb轴沿飞机纵轴且指向机头方向,Zb轴垂直ObXbYb平面,与ObXb、ObYb成右手定则;OgXgYgZg系坐标系原点在当地地球表面,Xg轴指向正东,Yg轴指向正北,Zg轴指向天向;OfXfYfZf系坐标原点Of为IMU敏感中心即三只加速度计敏感轴的交点,Xf轴指向右,Yf轴指向前,Zf轴指向上。OiXiYiZi系坐标原点为地心,Xi轴在地球赤道平面内,指向春分点,Zi轴指向地球极轴,Yi轴与Xi轴及Zi轴成右手定则;
(2)悬平飞机,使飞机载体系ObXbYb平面与当地地理系水平面OgXgYg平行。利用激光全站仪测量SAR天线阵面左上角点坐标PLU、右上角点坐标PRU、左下角点坐标PLD、右下角点坐标PRD、GPS天线坐标PGPS、IMU底座左前角点坐标PLF、左后角点坐标PLB、右后角点坐标PRB;
(3)根据步骤(1)所建立的坐标系及步骤(2)测量坐标计算IMU初始安装误差姿态阵SAR天线姿态阵IMU敏感中心坐标PIMU、IMU敏感中心至GPS天线中心的一级杆臂RI及IMU敏感中心至SAR天线中心的二级杆臂RII;
(4)进行飞行试验,采集飞行试验中IMU测量信息及GPS测量信息;其中,IMU测量信息为陀螺测量的角速度及加速度计测量的加速度,GPS测量信息为位置及速度;
(5)根据步骤(3)得到的IMU相对于飞机载体坐标系初始安装误差姿态阵及IMU结构设计的尺寸效应参数,利用步骤(4)中IMU测量输出信息,根据耦合安装误差的尺寸效应误差计算公式,补偿尺寸效应误差,得到IMU敏感中心比力,为SAR运动补偿提供准确的加速度基准;
(6)根据步骤(5)补偿尺寸效应误差及安装误差后的陀螺及加速度计输出,进行捷联解算,可以得到SINS输出的位置、速度及姿态,为SAR运补提供非滤波时刻的位置、速度及姿态基准;
(7)以步骤(4)测量得到的GPS位置、速度作为观测量,对步骤(6)得到的SINS信息及步骤(4)测量的GPS信息进行组合卡尔曼滤波,修正SINS位置、速度观测量信息中含有的一级杆臂效应误差分量,将修正后的状态反馈至步骤(6),并进行位置、速度及姿态的修正以消除步骤(6)解算结果的漂移,从而得到IMU敏感中心处的位置、速度及姿态信息;
(8)根据步骤(7)得到的IMU敏感中心处的位置、速度、姿态及步骤(5)得到的加速度,补偿二级杆臂并做姿态转换以得到SAR天线相位中心的位置、速度、加速度及姿态。
本发明的原理是:在SAR遥感成像过程中,POS为SAR提供精确的位置、速度、姿态及加速度信息进行运动补偿。由于POS系统本质上是一种SINS/GPS组合导航系统,加速度计的尺寸效应将产生有害加速度,进而导致SINS解算输出的位置、速度及姿态误差。而由于IMU与GPS天线安装位置不同引起的一级杆臂误差将会导致组合导航卡尔曼滤波时位置及速度误差观测量中含有杆臂误差,由于IMU与SAR天线中心不重合而导致POS输出的位置、速度、加速度等信息与SAR天线中心不一致,必须进行杆臂补偿。
因此,对尺寸效应、一级杆臂及二级杆臂的精确测量是杆臂误差补偿的前提。根据POS运补的特点,依据各传感器信号处理流程,首先需对尺寸效应误差进行补偿以消除加速度计的有害加速度,在消除尺寸效应时,需考虑IMU相对于载机安装误差耦合导致的尺寸效应变化。消除尺寸效应误差的加速度计信号及陀螺信号进行捷联解算后与同时刻的GPS测量信号进行组合卡尔曼滤波时需消除位置及速度误差观测量中含有的一级杆臂误差,组合滤波输出的结果即为POS输出。由于IMU与SAR天线安装位置不同,需将POS输出的位置、速度及加速度进行二级杆臂补偿以获得SAR天线中心的运动信息,同时,根据SAR天线坐标系姿态定义不同,需将POS输出姿态进行坐标变换转化至SAR天线坐标系。
本发明与现有技术相比的优点在于:本发明充分考虑了遥感测量中存在的各级杆臂包括尺寸效应,一级杆臂,二级杆臂。通过精确测量IMU相对于载机的安装姿态阵,确定了加速度计敏感轴方向发生改变引起的尺寸效应误差变化进而进行补偿,得到精确的IMU敏感中心比力信息。通过对一级杆臂、二级杆臂及SAR天线姿态阵的精确测量为各级杆臂补偿提供了基准,并根据杆臂引起的位置、速度、姿态误差关系进行补偿校正,充分降低了各级杆臂效应引起的误差。
附图说明
图1为本发明的杆臂测量及补偿的流程图;
图2为本发明的卡尔曼滤波基本算法的解算流程图。
具体实施方式
一种基于SAR遥感成像的杆臂测量及补偿方法主要分为两部分:第一部分是对杆臂误差(包括尺寸效应、一级杆臂、二级杆臂)的测量及IMU坐标系相对于载体系及SAR天线坐标系相对于载体系的安装误差姿态阵测量。二是利用测量的杆臂参数及初始安装姿态阵分别进行尺寸效应误差补偿、一级杆臂误差补偿及二级杆臂误差补偿及坐标变换。
本发明的具体方法如下:
(1)建立飞机载体坐标系ObXbYbZb、当地地理坐标系OgXgYgZg、IMU坐标系OfXfYfZf、地心惯性坐标系OiXiYiZi。其中,ObXbYbZb系坐标原点为飞机质心Ob,Xb轴指向飞机右翼水平方向,Yb轴沿飞机纵轴且指向机头方向,Zb轴垂直ObXbYb面,与ObXb、ObYb成右手定则;OgXgYgZg系坐标系原点在当地地球表面,Xg轴指向正东,Yg轴指向正北,Zg轴指向天向;OfXfYfZf系坐标原点Of为IMU敏感中心即三只加速度计敏感轴的交点,Xf轴指向右,Yf轴指向前,Zf轴指向上。OiXiYiZi系坐标原点为地心,Xi轴在地球赤道平面内,指向春分点,Zi轴指向地球极轴,Yi轴与Xi轴及Zi轴成右手定则;
(2)用千斤顶将飞机支撑悬空,利用全站仪测量将飞机调节为水平状态,即使飞机载体系ObXbYb与当地地理系水平面OgXgYg平行。在飞机前腹、后腹航向轴线上贴定标贴片,使用全站仪测定定标贴片坐标。利用激光全站仪测量SAR天线阵面四个角点的坐标分别为:左上角点坐标PLU,右上角点坐标PRU,左下角点坐标PLD,右下角点坐标PRD;GPS天线坐标PGPS,IMU底座三个角点坐标分别为:左前角点坐标PLF,左后角点坐标PLB,右后角点坐标PRB;
(3)根据步骤(1)所建立的坐标系及步骤(2)测量结果计算IMU初始安装误差姿态阵SAR天线姿态阵及IMU敏感中心坐标PIMU,IMU敏感中心至GPS天线中心的一级杆臂RI、IMU敏感中心至SAR天线中心的二级杆臂RII;
①SAR天线姿态阵计算方法:根据步骤(2)测定的SAR天线阵面四个角点坐标计算得到SAR天线阵面相对于载体系的姿态关系如下:
SAR航向角:
SAR俯仰角:
SAR横滚角:
其中,X,Y,Z代表坐标,下标LU,RU,LD,RD分别代表左上、右上,左下,右下角点。
②IMU初始安装姿态阵计算方法:根据步骤(2)测定的IMU壳体三个角点坐标计算得到IMU壳体相对于飞机载体坐标系初始安装姿态角计算如下:
IMU安装z向误差角:
其中,X,Y,Z代表坐标,下标LF,LB,RB分别代表左前、左后,右后角点。
由此,得到IMU坐标系f相对于飞机载体系b姿态变换矩阵为:
③IMU敏感中心坐标计算方法:根据步骤(2)测量得到的IMU底座三个角点坐标,左前角点坐标PLF,左后角点坐标PLB,右后角点坐标PLB以及IMU结构设计的尺寸关系图中IMU敏感中心至左前角点坐标相对位置矢量。计算得到IMU敏感中心Pf的三维坐标Xf,Yf,Zf为:
da,db,dc分别为IMU敏感中心至左前角点坐标相对位置矢量在X,Y,Z方向的分量。
④SAR天线相位中心坐标计算如下:根据测量得到的SAR天线阵面四个角点的三维坐标左上角点坐标PLU,右上角点坐标PRU,左下角点坐标PLD,右下角点坐标PRD。计算得到SAR天线相位中心坐标PS的三维坐标Xs,Ys,Zs为:
⑤一级杆臂计算如下:根据前述步骤得到的IMU敏感中心坐标Pf及GPS天线坐标PGPS得到GPS天线相对于IMU敏感中心相对位置即一级杆臂:
RI=[XGPS-Xf YGPS-Yf ZGPS-Zf]T
⑥二级杆臂计算如下:根据前述步骤得到的SAR天线相位中心坐标PS及IMU敏感中心坐标Pf计算得到IMU敏感中心相对于SAR天线相位中心相对位置即二级杆臂:
RII=[Xf-Xs Yf-Ys Zf-Zs]T;
(4)进行飞行试验,采集飞行试验中IMU测量信息及GPS测量信息。首先,在飞机静止状态下,将IMU开机预热30分钟,同时打开GPS流动站和基站采集GPS数据。然后,采集10分钟IMU数据及GPS数据,利用此段数据进行初始对准,得到IMU初始姿态。最后,飞机起飞飞往测区,在进入测区前做S型机动运动,随后进入测区进行遥感作业。整个过程中,IMU测量信息为陀螺测量的角速度Gx,Gy,Gz及加速度计测量的加速度 GPS测量信息为位置信息包括纬度Lgps,经度λgps及高度Hgps及速度包括东向速度VEgps,北向速度VNgps,天向速度VUgps;
(5)根据步骤(3)得到的IMU相对于飞机载体坐标系初始安装误差姿态阵及IMU结构设计的尺寸效应参数,利用步骤(4)中IMU测量输出信息,根据尺寸效应误差计算公式,对加速度计的输出误差进行补偿,以消除耦合安装误差带来的加速度计尺寸效应误差,得到IMU敏感中心比力。
具体方法如下:
①计算载体系ObXbYbZb相对于地心惯性系OiXiYiZi角速度为:
②耦合安装误差后,X、Y、Z轴加速度计的尺寸效应矢量为:
其中,
耦合安装误差后,X、Y、Z轴加速度计敏感轴方向如下:
其中,
③补偿加速度计耦合安装误差带来的尺寸效应误差,得到IMU敏感中心处比力如下:
耦合安装误差的加速度计尺寸效应误差为:
(6)根据步骤(5)补偿尺寸效应误差及安装误差后的陀螺及加速度计输出,进行捷联解算,可以得到SINS输出的位置、速度及姿态。SINS输出位置包括纬度Lsins、经度λsins和高度Hsins,速度包括东向速度VEsins、北向速度VNsins及天向速度VUsins及姿态:航向角ψsins,俯仰角θsins,滚动角γsins;
(7)以步骤(4)测量得到的GPS位置、速度作为观测量,对步骤(6)得到的SINS信息及GPS信息进行组合卡尔曼滤波,修正位置、速度观测量信息中含有的一级杆臂效应误差分量,将修正后的状态反馈至步骤(6),并进行位置、速度及姿态的修正以消除SINS位置、速度及姿态随时间累积引起的漂移,从而得到IMU敏感中心精确的位置、速度及姿态信息;
首先,列写卡尔曼滤波器的状态方程如下:
其中,x(t)为系统状态矢量,W为系统噪声矢量,F为系统转移矩阵,G为噪声转换矩阵:
x=[xf xa]T
xf=[δL δλ δH δVE δVN δVU φE φN φU]T
其中,δL为SINS解算的纬度误差,δλ为SINS解算的经度误差,δH为SINS解算的高度误差,δVE为SINS解算的东向速度误差,δVN为SINS解算的北向速度误差,δVU为SINS解算的天向速度误差,φE为SINS解算的东向失准角,φN为SINS解算的北向失准角,φU为SINS解算的天向失准角。εx、εy、εz分别为x、y、z轴陀螺的零漂, 分别为x、y、z轴加速度计的零偏。 分别为x、y、z轴陀螺的噪声, 分别为加速度计x、y、z的噪声。
系统转移矩阵各子矩阵表示如下:
上式中,VE、VN、VU分别为SINS的东、北、天向速度,RM、RN为地球的子午圈主曲率半径,卯酉圈主曲率半径,L为纬度,H为高度,ωie为地球自转角速度。
系统的量测方程
z(t)=H(t)x(t)+v(t)
其中:Z为观测矢量,H为观测矩阵,v(t)为量测噪声:
z=[δL′δλ′δH′δV′E δV′N δV′U]T
δL′、δλ′、δH′、δV′E、δV′N和δV′U分别为SINS与GPS的纬度、经度和高度与东向速度、北向速度、天向速度之差;
量测矩阵H=[HP HV]T
HP=[03×6 diag(RM+H,(RN+H)cosL,1)03×6]
HV=[03×3 diag(1,1,1)03×9]
假定w(t)和v(t)为零均值的高斯白噪声,即满足:
式中:Q∈Rlxl过程噪声方差阵,假设为非负定阵;R∈Rmxm为量测噪声方差阵,假设为正定阵;Δt为采样时间间隔。
设t=tk-1,t+Δt=tk。tk时刻的线性离散型系统方程可表示为:
yk=Hkxk+vk
式中:Φk/k-1为状态转移矩阵F的离散化形式。当Δt(即滤波周期)较短时,F(t)可近似看作常阵,即:
F(t)≈F(tk-1) tk-1≤t<tk
此时,状态转移矩阵Φk/k-1有如下计算式:
在观测量z中对一级杆臂效应误差进行补偿:
∏=diag([(RM+H)-1,secL/(RN+H),1])
离散化的卡尔曼滤波基本算法编排:
状态一步预测方程:
状态估值计算方程:
滤波增量方程:
一步预测均方误差方程:
估计均方误差方程:
卡尔曼滤波流程图如图2所示,左右侧回路分别为增益计算回路及滤波计算回路。在增益计算回路中,根据系统状态转移矩阵Φk/k-1、前一时刻的估计均方误差Pk-1、系统噪声方差阵Qk-1得到一步预测均方误差Pk/k-1,由Pk/k-1及观测矩阵Hk和量测噪声方差阵Rk得到滤波增益阵Kk。根据Kk及Pk/k-1得到本次估计均方误差。在滤波计算回路中,由前一时刻状态估值及Φk/k-1得到状态单步预测由量测Zk及滤波增益Kk得到状态估计
经过卡尔曼滤波,得到该时刻的位置误差估计值δL、δλ、δH,速度误差估计值δVE、δVN、δVU,姿态误差估计值φE、φN、φU。
将得到的滤波估值反馈至步骤(6)的SINS解算位置、速度、姿态进行修正。
IMU敏感中心位置修正:
[Limu λimu Himu]T=[Lsins λsins Hsins]T-[δL δλ δH]T
IMU敏感中心速度修正:
[VEimu VNimu VUimu]T=[VEsins VUsins VNsins]T-[δVE δVN δVU]T
IMU敏感中心姿态修正:
(8)根据步骤(7)得到的IMU敏感中心处的位置、速度、姿态及步骤(5)得到的加速度,补偿二级杆臂并做姿态转换以得到SAR天线相位中心的位置、速度、加速度及姿态。
将IMU敏感中心的位置、速度、加速度进行二级杆臂补偿,得到SAR天线相位中心的位置、速度、加速度及姿态如下:
Claims (5)
1.一种基于SAR遥感成像的杆臂测量及补偿方法,其特征在于包括下列步骤:
(1)建立飞机载体坐标系b系ObXbYbZb、当地地理坐标系g系OgXgYgZg、IMU坐标系f系OfXfYfZf、地心惯性坐标系i系OiXiYiZi。其中,ObXbYbZb系坐标原点为飞机质心Ob,Xb轴指向飞机右翼水平方向,Yb轴沿飞机纵轴且指向机头方向,Zb轴垂直ObXbYb平面,与ObXb、ObYb成右手定则;OgXgYgZg系坐标系原点在当地地球表面,Xg轴指向正东,Yg轴指向正北,Zg轴指向天向;OfXfYfZf系坐标原点Of为IMU敏感中心即三只加速度计敏感轴的交点,Xf轴指向右,Yf轴指向前,Zf轴指向上。OiXiYiZi系坐标原点为地心,Xi轴在地球赤道平面内,指向春分点,Zi轴指向地球极轴,Yi轴与Xi轴及Zi轴成右手定则;
(2)悬平飞机,使飞机载体系ObXbYb平面与当地地理系水平面OgXgYg平行,利用激光全站仪测量SAR天线阵面左上角点坐标PLU、右上角点坐标PRU、左下角点坐标PLD、右下角点坐标PRD、GPS天线坐标PGPS、IMU底座左前角点坐标PLF、左后角点坐标PLB、右后角点坐标PRB;
(3)根据步骤(1)所建立的坐标系及通过步骤(2)测量得到的坐标,计算IMU初始安装误差姿态阵SAR天线姿态阵IMU敏感中心坐标PIMU、IMU敏感中心至GPS天线中心的一级杆臂RI及IMU敏感中心至SAR天线中心的二级杆臂RII;
(4)进行飞行试验,采集飞行试验中IMU测量信息及GPS测量信息。其中,IMU测量信息为陀螺测量的角速度及加速度计测量的加速度,GPS测量信息为位置及速度;
(5)根据步骤(3)得到的IMU相对于飞机载体坐标系初始安装误差姿态阵及IMU结构设计的尺寸效应参数,利用步骤(4)中IMU测量输出信息,根据耦合安装误差的尺寸效应误差计算公式,补偿尺寸效应误差,得到IMU敏感中心比力,为SAR运动补偿提供准确的加速度基准;
(6)根据步骤(5)补偿尺寸效应误差及安装误差后的陀螺及加速度计输出,进行捷联解算,可以得到SINS位置、速度及姿态;
(7)以步骤(4)测量得到的GPS位置、速度作为观测量,对步骤(6)得到的SINS信息及步骤(4)测量的GPS信息进行组合卡尔曼滤波,修正SINS的位置、速度观测量信息中含有的一级杆臂效应误差分量,将修正后的状态反馈至步骤(6),并进行位置、速度及姿态的修正以消除步骤(6)解算结果的漂移,从而得到IMU敏感中心处校正捷联解算误差后的位置、速度及姿态信息;
(8)根据步骤(7)得到的IMU敏感中心处的位置、速度、姿态及步骤(5)得到的加速度,根据二级杆臂引起的位置、速度、加速度及姿态误差关系,补偿二级杆臂并做姿态转换以得到SAR天线相位中心的位置、速度、加速度及姿态。
4.根据权利要求1和权利要求3所述的一种基于SAR遥感成像的杆臂测量及补偿方法,其特征在于:步骤(3)所述的IMU敏感中心坐标计算方法为:
根据步骤(2)测量得到的IMU底座三个角点坐标,左前角点坐标PLF,左后角点坐标PLB,右后角点坐标PLB以及IMU结构设计的尺寸关系图中IMU敏感中心至左前角点坐标相对位置矢量,计算得到IMU敏感中心PIMU的三维坐标为:
式中da,db,dc分别为IMU敏感中心至左前角点坐标相对位置矢量在IMU坐标系X,Y,Z方向的分量,由结构尺寸得到;Xf,Yf,Zf分别为IMU敏感中心坐标Pf在IMU坐标系的三个分量。
5.根据权利要求1或权利要求3所述的一种基于SAR遥感成像的杆臂测量及补偿方法,其特征在于:步骤(5)所述的补偿耦合安装误差的尺寸效应误差,得到IMU敏感中心的比力的方法为:
①计算载体系ObXbYbZb相对于地心惯性系OiXiYiZi角速度为:
其中,Gx,Gy,Gz分别为陀螺X、Y、Z的测量输出,为载体系相对于惯性系的角速度在载体系的三维投影;
②耦合安装误差后,X、Y、Z轴加速度计的尺寸效应矢量为:
其中,
耦合安装误差后,X、Y、Z轴加速度计敏感轴方向如下:
其中,
③补偿加速度计耦合安装误差带来的尺寸效应误差,得到IMU敏感中心处比力如下:
耦合安装误差的加速度计尺寸效应误差为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210324761.3A CN102879779B (zh) | 2012-09-04 | 2012-09-04 | 一种基于sar遥感成像的杆臂测量及补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210324761.3A CN102879779B (zh) | 2012-09-04 | 2012-09-04 | 一种基于sar遥感成像的杆臂测量及补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102879779A true CN102879779A (zh) | 2013-01-16 |
CN102879779B CN102879779B (zh) | 2014-05-07 |
Family
ID=47481174
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210324761.3A Expired - Fee Related CN102879779B (zh) | 2012-09-04 | 2012-09-04 | 一种基于sar遥感成像的杆臂测量及补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102879779B (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103344259A (zh) * | 2013-07-11 | 2013-10-09 | 北京航空航天大学 | 一种基于杆臂估计的ins/gps组合导航系统反馈校正方法 |
CN103630146A (zh) * | 2013-09-15 | 2014-03-12 | 北京航空航天大学 | 一种离散解析与Kalman滤波结合的激光陀螺IMU标定方法 |
CN104698486A (zh) * | 2015-03-26 | 2015-06-10 | 北京航空航天大学 | 一种分布式pos用数据处理计算机系统实时导航方法 |
CN105571578A (zh) * | 2015-12-14 | 2016-05-11 | 武汉大学 | 一种利用伪观测取代精密转台的原地旋转调制寻北方法 |
CN105928513A (zh) * | 2016-04-12 | 2016-09-07 | 北京航空航天大学 | 一种基于位置姿态测量系统的机载合成孔径雷达运动参数测量方法 |
CN106054185A (zh) * | 2016-05-23 | 2016-10-26 | 北京航空航天大学 | 一种基于分布式POS的机载双天线InSAR基线计算方法 |
CN108225312A (zh) * | 2017-12-27 | 2018-06-29 | 中国电子科技集团公司第五十四研究所 | 一种gnss/ins松组合中杆臂估计以及补偿方法 |
CN108759845A (zh) * | 2018-07-05 | 2018-11-06 | 华南理工大学 | 一种基于低成本多传感器组合导航的优化方法 |
CN108828644A (zh) * | 2018-03-13 | 2018-11-16 | 西安芯思卓信息科技有限公司 | Gnss/mems紧组合导航系统中动态突变识别方法 |
CN110873578A (zh) * | 2020-01-17 | 2020-03-10 | 立得空间信息技术股份有限公司 | 一种基于转台传递的六面体棱镜和imu安装误差标定方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5505410A (en) * | 1994-05-23 | 1996-04-09 | Litton Systems, Inc. | Instrument calibration method including compensation of centripetal acceleration effect |
US5574650A (en) * | 1993-03-23 | 1996-11-12 | Litton Systems, Inc. | Method and apparatus for calibrating the gyros of a strapdown inertial navigation system |
CN101067657A (zh) * | 2007-02-28 | 2007-11-07 | 北京航空航天大学 | 一种机载双天线双测量装置干涉sar基线运动测量方法 |
CN102305929A (zh) * | 2011-05-26 | 2012-01-04 | 中国人民解放军国防科学技术大学 | 机载合成孔径雷达杠杆臂误差补偿方法 |
-
2012
- 2012-09-04 CN CN201210324761.3A patent/CN102879779B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5574650A (en) * | 1993-03-23 | 1996-11-12 | Litton Systems, Inc. | Method and apparatus for calibrating the gyros of a strapdown inertial navigation system |
US5505410A (en) * | 1994-05-23 | 1996-04-09 | Litton Systems, Inc. | Instrument calibration method including compensation of centripetal acceleration effect |
CN101067657A (zh) * | 2007-02-28 | 2007-11-07 | 北京航空航天大学 | 一种机载双天线双测量装置干涉sar基线运动测量方法 |
CN102305929A (zh) * | 2011-05-26 | 2012-01-04 | 中国人民解放军国防科学技术大学 | 机载合成孔径雷达杠杆臂误差补偿方法 |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103344259A (zh) * | 2013-07-11 | 2013-10-09 | 北京航空航天大学 | 一种基于杆臂估计的ins/gps组合导航系统反馈校正方法 |
CN103344259B (zh) * | 2013-07-11 | 2016-01-20 | 北京航空航天大学 | 一种基于杆臂估计的ins/gps组合导航系统反馈校正方法 |
CN103630146A (zh) * | 2013-09-15 | 2014-03-12 | 北京航空航天大学 | 一种离散解析与Kalman滤波结合的激光陀螺IMU标定方法 |
CN104698486A (zh) * | 2015-03-26 | 2015-06-10 | 北京航空航天大学 | 一种分布式pos用数据处理计算机系统实时导航方法 |
CN105571578A (zh) * | 2015-12-14 | 2016-05-11 | 武汉大学 | 一种利用伪观测取代精密转台的原地旋转调制寻北方法 |
CN105571578B (zh) * | 2015-12-14 | 2016-09-14 | 武汉大学 | 一种利用伪观测取代精密转台的原地旋转调制寻北方法 |
CN105928513A (zh) * | 2016-04-12 | 2016-09-07 | 北京航空航天大学 | 一种基于位置姿态测量系统的机载合成孔径雷达运动参数测量方法 |
CN106054185B (zh) * | 2016-05-23 | 2018-01-09 | 北京航空航天大学 | 一种基于分布式POS的机载双天线InSAR基线计算方法 |
CN106054185A (zh) * | 2016-05-23 | 2016-10-26 | 北京航空航天大学 | 一种基于分布式POS的机载双天线InSAR基线计算方法 |
CN108225312A (zh) * | 2017-12-27 | 2018-06-29 | 中国电子科技集团公司第五十四研究所 | 一种gnss/ins松组合中杆臂估计以及补偿方法 |
CN108225312B (zh) * | 2017-12-27 | 2020-05-08 | 中国电子科技集团公司第五十四研究所 | 一种gnss/ins松组合中杆臂估计以及补偿方法 |
CN108828644A (zh) * | 2018-03-13 | 2018-11-16 | 西安芯思卓信息科技有限公司 | Gnss/mems紧组合导航系统中动态突变识别方法 |
CN108828644B (zh) * | 2018-03-13 | 2019-06-25 | 西安芯思卓信息科技有限公司 | Gnss/mems紧组合导航系统中动态突变识别方法 |
CN108759845A (zh) * | 2018-07-05 | 2018-11-06 | 华南理工大学 | 一种基于低成本多传感器组合导航的优化方法 |
CN108759845B (zh) * | 2018-07-05 | 2021-08-10 | 华南理工大学 | 一种基于低成本多传感器组合导航的优化方法 |
CN110873578A (zh) * | 2020-01-17 | 2020-03-10 | 立得空间信息技术股份有限公司 | 一种基于转台传递的六面体棱镜和imu安装误差标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN102879779B (zh) | 2014-05-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102879779B (zh) | 一种基于sar遥感成像的杆臂测量及补偿方法 | |
CN107655476B (zh) | 基于多信息融合补偿的行人高精度足部导航方法 | |
CN102506857B (zh) | 一种基于双imu/dgps组合的相对姿态测量实时动态滤波方法 | |
US11409001B2 (en) | Method for tilt measurement and compensation of surveying instrument based on GNSS receiver and IMU sensor | |
CN103344259B (zh) | 一种基于杆臂估计的ins/gps组合导航系统反馈校正方法 | |
CN103196448B (zh) | 一种机载分布式惯性测姿系统及其传递对准方法 | |
CN109974697B (zh) | 一种基于惯性系统的高精度测绘方法 | |
CN108226985B (zh) | 基于精密单点定位的列车组合导航方法 | |
US9784582B2 (en) | Method and apparatus for navigation with nonlinear models | |
CN102169184B (zh) | 组合导航系统中测量双天线gps安装失准角的方法和装置 | |
US6876926B2 (en) | Method and system for processing pulse signals within an inertial navigation system | |
CN102538792B (zh) | 一种位置姿态系统的滤波方法 | |
CN107270893A (zh) | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 | |
US20130138264A1 (en) | Automotive navigation system and method to utilize internal geometry of sensor position with respect to rear wheel axis | |
US20120065883A1 (en) | Gps/ins sensor fusion using gps wind up model | |
US20170074678A1 (en) | Positioning and orientation data analysis system and method thereof | |
CN110133692B (zh) | 惯导技术辅助的高精度gnss动态倾斜测量系统及方法 | |
CN104697526A (zh) | 用于农业机械的捷联惯导系统以及控制方法 | |
CN102519470A (zh) | 多级嵌入式组合导航系统及导航方法 | |
CN107015259A (zh) | 采用多普勒测速仪计算伪距/伪距率的紧组合方法 | |
CN103674034A (zh) | 多波束测速测距修正的鲁棒导航方法 | |
CN103674064B (zh) | 捷联惯性导航系统的初始标定方法 | |
CN114739425A (zh) | 基于rtk-gnss及全站仪的采煤机定位标定系统及应用方法 | |
CN102621570A (zh) | 基于双全球定位和惯性测量的汽车动力学参数测量方法 | |
CN103604428A (zh) | 基于高精度水平基准的星敏感器定位方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20140507 Termination date: 20180904 |